kern/linux/printk.cc

   1 /*
   2  * Copyright (c) 2004-2005 The Regents of The University of Michigan
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions are
   7  * met: redistributions of source code must retain the above copyright
   8  * notice, this list of conditions and the following disclaimer;
   9  * redistributions in binary form must reproduce the above copyright
  10  * notice, this list of conditions and the following disclaimer in the
  11  * documentation and/or other materials provided with the distribution;
  12  * neither the name of the copyright holders nor the names of its
  13  * contributors may be used to endorse or promote products derived from
  14  * this software without specific prior written permission.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  17  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  18  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  19  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  20  * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  21  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  22  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  23  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  24  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  25  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  26  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  27  */
  28
  29 #include <sys/types.h>
  30 #include <algorithm>
  31
  32 #include "base/trace.hh"
  33 #include "arch/arguments.hh"
  34
  35 using namespace std;
  36
  37
  38 void
  39 Printk(AlphaISA::AlphaArguments args)
  40 {
  41     char *p = (char *)args++;
  42
  43     ios::fmtflags saved_flags = DebugOut().flags();
  44     char old_fill = DebugOut().fill();
  45     int old_precision = DebugOut().precision();
  46
  47     while (*p) {
  48         switch (*p) {
  49           case '%': {
  50               bool more = true;
  51               bool islong = false;
  52               bool leftjustify = false;
  53               bool format = false;
  54               bool zero = false;
  55               int width = 0;
  56               while (more && *++p) {
  57                   switch (*p) {
  58                     case 'l':
  59                     case 'L':
  60                       islong = true;
  61                       break;
  62                     case '-':
  63                       leftjustify = true;
  64                       break;
  65                     case '#':
  66                       format = true;
  67                       break;
  68                     case '0':
  69                       if (width)
  70                           width *= 10;
  71                       else
  72                           zero = true;
  73                       break;
  74                     default:
  75                       if (*p >= '1' && *p <= '9')
  76                           width = 10 * width + *p - '0';
  77                       else
  78                           more = false;
  79                       break;
  80                   }
  81               }
  82
  83               bool hexnum = false;
  84               bool octal = false;
  85               bool sign = false;
  86               switch (*p) {
  87                 case 'X':
  88                 case 'x':
  89                   hexnum = true;
  90                   break;
  91                 case 'O':
  92                 case 'o':
  93                   octal = true;
  94                   break;
  95                 case 'D':
  96                 case 'd':
  97                   sign = true;
  98                   break;
  99                 case 'P':
 100                   format = true;
 101                 case 'p':
 102                   hexnum = true;
 103                   break;
 104               }
 105
 106               switch (*p) {
 107                 case 'D':
 108                 case 'd':
 109                 case 'U':
 110                 case 'u':
 111                 case 'X':
 112                 case 'x':
 113                 case 'O':
 114                 case 'o':
 115                 case 'P':
 116                 case 'p': {
 117                   if (hexnum)
 118                       DebugOut() << hex;
 119
 120                   if (octal)
 121                       DebugOut() << oct;
 122
 123                   if (format) {
 124                       if (!zero)
 125                           DebugOut().setf(ios::showbase);
 126                       else {
 127                           if (hexnum) {
 128                               DebugOut() << "0x";
 129                               width -= 2;
 130                           } else if (octal) {
 131                               DebugOut() << "0";
 132                               width -= 1;
 133                           }
 134                       }
 135                   }
 136
 137                   if (zero)
 138                       DebugOut().fill('0');
 139
 140                   if (width > 0)
 141                       DebugOut().width(width);
 142
 143                   if (leftjustify && !zero)
 144                       DebugOut().setf(ios::left);
 145
 146                   if (sign) {
 147                       if (islong)
 148                           DebugOut() << (int64_t)args;
 149                       else
 150                           DebugOut() << (int32_t)args;
 151                   } else {
 152                       if (islong)
 153                           DebugOut() << (uint64_t)args;
 154                       else
 155                           DebugOut() << (uint32_t)args;
 156                   }
 157
 158                   if (zero)
 159                       DebugOut().fill(' ');
 160
 161                   if (width > 0)
 162                       DebugOut().width(0);
 163
 164                   DebugOut() << dec;
 165
 166                   ++args;
 167                 }
 168                   break;
 169
 170                 case 's': {
 171                     char *s = (char *)args;
 172                     if (!s)
 173                         s = "<NULL>";
 174
 175                     if (width > 0)
 176                         DebugOut().width(width);
 177                     if (leftjustify)
 178                         DebugOut().setf(ios::left);
 179
 180                     DebugOut() << s;
 181                     ++args;
 182                 }
 183                   break;
 184                 case 'C':
 185                 case 'c': {
 186                     uint64_t mask = (*p == 'C') ? 0xffL : 0x7fL;
 187                     uint64_t num;
 188                     int width;
 189
 190                     if (islong) {
 191                         num = (uint64_t)args;
 192                         width = sizeof(uint64_t);
 193                     } else {
 194                         num = (uint32_t)args;
 195                         width = sizeof(uint32_t);
 196                     }
 197
 198                     while (width-- > 0) {
 199                         char c = (char)(num & mask);
 200                         if (c)
 201                             DebugOut() << c;
 202                         num >>= 8;
 203                     }
 204
 205                     ++args;
 206                 }
 207                   break;
 208                 case 'b': {
 209                   uint64_t n = (uint64_t)args++;
 210                   char *s = (char *)args++;
 211                   DebugOut() << s << ": " << n;
 212                 }
 213                   break;
 214                 case 'n':
 215                 case 'N': {
 216                     args += 2;
 217 #if 0
 218                     uint64_t n = (uint64_t)args++;
 219                     struct reg_values *rv = (struct reg_values *)args++;
 220 #endif
 221                 }
 222                   break;
 223                 case 'r':
 224                 case 'R': {
 225                     args += 2;
 226 #if 0
 227                     uint64_t n = (uint64_t)args++;
 228                     struct reg_desc *rd = (struct reg_desc *)args++;
 229 #endif
 230                 }
 231                   break;
 232                 case '%':
 233                   DebugOut() << '%';
 234                   break;
 235               }
 236               ++p;
 237           }
 238             break;
 239           case '\n':
 240             DebugOut() << endl;
 241             ++p;
 242             break;
 243           case '\r':
 244             ++p;
 245             if (*p != '\n')
 246                 DebugOut() << endl;
 247             break;
 248
 249           default: {
 250               size_t len = strcspn(p, "%\n\r\0");
 251               DebugOut().write(p, len);
 252               p += len;
 253           }
 254         }
 255     }
 256
 257     DebugOut().flags(saved_flags);
 258     DebugOut().fill(old_fill);
 259     DebugOut().precision(old_precision);
 260 }
 261