printk.cc revision 5202:ff56fa8c2091 
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 * Authors: Nathan Binkert
29 *          Ali Saidi
30 */
31
32#include <sys/types.h>
33#include <algorithm>
34
35#include "sim/arguments.hh"
36#include "base/trace.hh"
37#include "kern/linux/printk.hh"
38
39using namespace std;
40
41
42void
43Printk(stringstream &out, Arguments args)
44{
45    char *p = (char *)args++;
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                      out << hex;
119
120                  if (octal)
121                      out << oct;
122
123                  if (format) {
124                      if (!zero)
125                          out.setf(ios::showbase);
126                      else {
127                          if (hexnum) {
128                              out << "0x";
129                              width -= 2;
130                          } else if (octal) {
131                              out << "0";
132                              width -= 1;
133                          }
134                      }
135                  }
136
137                  if (zero)
138                      out.fill('0');
139
140                  if (width > 0)
141                      out.width(width);
142
143                  if (leftjustify && !zero)
144                      out.setf(ios::left);
145
146                  if (sign) {
147                      if (islong)
148                          out << (int64_t)args;
149                      else
150                          out << (int32_t)args;
151                  } else {
152                      if (islong)
153                          out << (uint64_t)args;
154                      else
155                          out << (uint32_t)args;
156                  }
157
158                  if (zero)
159                      out.fill(' ');
160
161                  if (width > 0)
162                      out.width(0);
163
164                  out << dec;
165
166                  ++args;
167                }
168                  break;
169
170                case 's': {
171                    const char *s = (const char *)args;
172                    if (!s)
173                        s = "<NULL>";
174
175                    if (width > 0)
176                        out.width(width);
177                    if (leftjustify)
178                        out.setf(ios::left);
179
180                    out << 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                            out << 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                  out << 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                  out << '%';
234                  break;
235              }
236              ++p;
237          }
238            break;
239          case '\n':
240            out << endl;
241            ++p;
242            break;
243          case '\r':
244            ++p;
245            if (*p != '\n')
246                out << endl;
247            break;
248
249          default: {
250              size_t len = strcspn(p, "%\n\r\0");
251              out.write(p, len);
252              p += len;
253          }
254        }
255    }
256
257}
258
259