Reworks memlayout (XCC)
[akaros.git] / kern / arch / x86 / kdebug.c
1 #ifdef __SHARC__
2 #pragma nosharc
3 #endif
4
5 #include <stab.h>
6 #include <string.h>
7 #include <assert.h>
8 #include <kdebug.h>
9 #include <pmap.h>
10 #include <process.h>
11
12 #include <ros/memlayout.h>
13
14 // Beginning of stabs table
15 extern const stab_t (RO BND(__this,__STAB_END__) __STAB_BEGIN__)[];
16
17 // End of stabs table
18 extern const stab_t (RO SNT __STAB_END__)[];
19
20 // Beginning of string table
21 extern const char (RO NT BND(__this,__STABSTR_END__) __STABSTR_BEGIN__)[];
22
23  // End of string table
24 extern const char (RO SNT __STABSTR_END__)[];
25
26 typedef struct UserStabData {
27         const stab_t *BND(__this,stab_end) stabs;
28         const stab_t *SNT stab_end;
29         const char *NT BND(__this, stabstr_end) stabstr;
30         const char *SNT stabstr_end;
31 } user_stab_data_t;
32
33
34 /* We used to check for a null terminating byte for the entire strings section
35  * (due to JOS, I think), but that's not what the spec says: only that all
36  * strings are null terminated.  There might be random stuff tacked on at the
37  * end.  I had some stabs that seemed valid (lookups worked), that did not have
38  * the entire table be null terminated.  Still, something else might be jacked
39  * up.  If it turns out that's the case, put the checks in here. */
40 static bool stab_table_valid(const char *stabstr, const char *stabstr_end)
41 {
42         if (stabstr_end <= stabstr)
43                 return FALSE;
44         return TRUE;
45 }
46
47 // stab_binsearch(stabs, region_left, region_right, type, addr)
48 //
49 //      Some stab types are arranged in increasing order by instruction
50 //      address.  For example, N_FUN stabs (stab entries with n_type ==
51 //      N_FUN), which mark functions, and N_SO stabs, which mark source files.
52 //
53 //      Given an instruction address, this function finds the single stab
54 //      entry of type 'type' that contains that address.
55 //
56 //      The search takes place within the range [*region_left, *region_right].
57 //      Thus, to search an entire set of N stabs, you might do:
58 //
59 //              left = 0;
60 //              right = N - 1;     /* rightmost stab */
61 //              stab_binsearch(stabs, &left, &right, type, addr);
62 //
63 //      The search modifies *region_left and *region_right to bracket the
64 //      'addr'.  *region_left points to the matching stab that contains
65 //      'addr', and *region_right points just before the next stab.  If
66 //      *region_left > *region_right, then 'addr' is not contained in any
67 //      matching stab.
68 //
69 //      For example, given these N_SO stabs:
70 //              Index  Type   Address
71 //              0      SO     f0100000
72 //              13     SO     f0100040
73 //              117    SO     f0100176
74 //              118    SO     f0100178
75 //              555    SO     f0100652
76 //              556    SO     f0100654
77 //              657    SO     f0100849
78 //      this code:
79 //              left = 0, right = 657;
80 //              stab_binsearch(stabs, &left, &right, N_SO, 0xf0100184);
81 //      will exit setting left = 118, right = 554.
82 //
83 static void
84 stab_binsearch(const stab_t *BND(__this, stab_end) stabs,
85            const stab_t *SNT stab_end,
86            int *region_left, int *region_right,
87                int type, uintptr_t addr)
88 {
89         int l = *region_left, r = *region_right, any_matches = 0;
90         
91         while (l <= r) {
92                 int true_m = (l + r) / 2, m = true_m;
93                 
94                 // search for earliest stab with right type
95                 while (m >= l && stabs[m].n_type != type)
96                         m--;
97                 if (m < l) {    // no match in [l, m]
98                         l = true_m + 1;
99                         continue;
100                 }
101
102                 // actual binary search
103                 any_matches = 1;
104                 if (stabs[m].n_value < addr) {
105                         *region_left = m;
106                         l = true_m + 1;
107                 } else if (stabs[m].n_value > addr) {
108                         *region_right = m - 1;
109                         r = m - 1;
110                 } else {
111                         // exact match for 'addr', but continue loop to find
112                         // *region_right
113                         *region_left = m;
114                         l = m;
115                         addr++;
116                 }
117         }
118
119         if (!any_matches)
120                 *region_right = *region_left - 1;
121         else {
122                 // find rightmost region containing 'addr'
123                 for (l = *region_right;
124                      l > *region_left && stabs[l].n_type != type;
125                      l--)
126                         /* do nothing */;
127                 *region_left = l;
128         }
129 }
130
131
132 // debuginfo_eip(addr, info)
133 //
134 //      Fill in the 'info' structure with information about the specified
135 //      instruction address, 'addr'.  Returns 0 if information was found, and
136 //      negative if not.  But even if it returns negative it has stored some
137 //      information into '*info'.
138 //
139 int
140 debuginfo_eip(uintptr_t addr, eipdebuginfo_t *NONNULL info)
141 {
142         const stab_t *SNT stab_end;
143         const stab_t *BND(__this,stab_end) stabs;
144         const char *SNT stabstr_end;
145         const char *NT BND(__this,stabstr_end) stabstr;
146         int lfile, rfile, lfun, rfun, lline, rline;
147
148         // Initialize *info
149         info->eip_file = "<unknown>";
150         info->eip_line = 0;
151         info->eip_fn_name = "<unknown>";
152         info->eip_fn_namelen = 9;
153         info->eip_fn_addr = addr;
154         info->eip_fn_narg = 0;
155
156         // Find the relevant set of stabs
157         if (addr >= ULIM) {
158                 stab_end = __STAB_END__;
159                 stabs = __STAB_BEGIN__;
160                 stabstr_end = __STABSTR_END__;
161                 stabstr = __STABSTR_BEGIN__;
162         } else {
163                 /* TODO: short circuiting this, til our user space apps pack stab data
164                  * the kernel knows about */
165                 return -1;
166                 #if 0
167                 // The user-application linker script, user/user.ld,
168                 // puts information about the application's stabs (equivalent
169                 // to __STAB_BEGIN__, __STAB_END__, __STABSTR_BEGIN__, and
170                 // __STABSTR_END__) in a structure located at virtual address
171                 // USTABDATA.
172                 const user_stab_data_t *usd = (const user_stab_data_t *COUNT(1))TC(USTABDATA);
173
174                 // Make sure this memory is valid.
175                 // Return -1 if it is not.  Hint: Call user_mem_check.
176                 // LAB 3: Your code here.
177
178                 stab_end = usd->stab_end;
179                 stabs = usd->stabs;
180                 stabstr_end = usd->stabstr_end;
181                 stabstr = usd->stabstr;
182
183                 // Make sure the STABS and string table memory is valid.
184                 // LAB 3: Your code here.
185                 #endif
186         }
187
188         if (!stab_table_valid(stabstr, stabstr_end))
189                 return -1;
190
191         // Now we find the right stabs that define the function containing
192         // 'eip'.  First, we find the basic source file containing 'eip'.
193         // Then, we look in that source file for the function.  Then we look
194         // for the line number.
195         
196         // Search the entire set of stabs for the source file (type N_SO).
197         lfile = 0;
198         rfile = (stab_end - stabs) - 1;
199         stab_binsearch(stabs, stab_end, &lfile, &rfile, N_SO, addr);
200         if (lfile == 0)
201                 return -1;
202
203         // Search within that file's stabs for the function definition
204         // (N_FUN).
205         lfun = lfile;
206         rfun = rfile;
207         stab_binsearch(stabs, stab_end, &lfun, &rfun, N_FUN, addr);
208
209         if (lfun <= rfun) {
210                 // stabs[lfun] points to the function name
211                 // in the string table, but check bounds just in case.
212                 if (stabs[lfun].n_strx < stabstr_end - stabstr)
213                         info->eip_fn_name = stabstr + stabs[lfun].n_strx;
214                 info->eip_fn_addr = stabs[lfun].n_value;
215                 addr -= info->eip_fn_addr;
216                 // Search within the function definition for the line number.
217                 lline = lfun;
218                 rline = rfun;
219         } else {
220                 // Couldn't find function stab!  Maybe we're in an assembly
221                 // file.  Search the whole file for the line number.
222                 info->eip_fn_addr = addr;
223                 lline = lfile;
224                 rline = rfile;
225         }
226         // Ignore stuff after the colon.
227         info->eip_fn_namelen = strfind(info->eip_fn_name, ':') - info->eip_fn_name;
228         
229         // Search within [lline, rline] for the line number stab.
230         // If found, set info->eip_line to the right line number.
231         // If not found, return -1.
232         //
233         // Hint:
234         //      There's a particular stabs type used for line numbers.
235         //      Look at the STABS documentation and <inc/stab.h> to find
236         //      which one.
237         // Your code here.
238
239         stab_binsearch(stabs, stab_end, &lline, &rline, N_SLINE, addr);
240         if (lline <= rline) 
241                 // stabs[lline] points to the line number
242                 info->eip_line = stabs[lline].n_value;
243         else
244                 return -1;
245         
246         // Search backwards from the line number for the relevant filename
247         // stab.
248         // We can't just use the "lfile" stab because inlined functions
249         // can interpolate code from a different file!
250         // Such included source files use the N_SOL stab type.
251         while (lline >= lfile
252                && stabs[lline].n_type != N_SOL
253                && (stabs[lline].n_type != N_SO || !stabs[lline].n_value))
254                 lline--;
255         if (lline >= lfile && stabs[lline].n_strx < stabstr_end - stabstr)
256                 info->eip_file = stabstr + stabs[lline].n_strx;
257
258         // Set eip_fn_narg to the number of arguments taken by the function,
259         // or 0 if there was no containing function.
260         // Your code here.
261         info->eip_fn_narg = 0;
262         if (lfun <= rfun) {
263                 lfun++;
264                 while (stabs[lfun++].n_type == N_PSYM)
265                         info->eip_fn_narg++;
266         }
267         
268         return 0;
269 }
270
271 /* Returns a function pointer for a function name matching the given string. */
272 void *debug_get_fn_addr(char *fn_name)
273 {
274         const struct stab *SNT stab_end = __STAB_END__;
275         const struct stab *BND(__this,stab_end) stabs = __STAB_BEGIN__;
276         const char *SNT stabstr_end = __STABSTR_END__;
277         const char *NT BND(__this,stabstr_end) stabstr = __STABSTR_BEGIN__;
278
279         static int first_fn_idx = 0;
280         int i = first_fn_idx;
281         int len;
282         const char *stab_fn_name = 0;
283         void *retval = 0;
284
285         if (!stab_table_valid(stabstr, stabstr_end))
286                 return 0;
287
288         for (/* i set */; &stabs[i] < stab_end; i++) {
289                 if (stabs[i].n_type != N_FUN)
290                         continue;
291                 first_fn_idx = first_fn_idx ? first_fn_idx : i;
292                 /* broken stab, just keep going */
293                 if (!(stabs[i].n_strx < stabstr_end - stabstr))
294                         continue;
295                 stab_fn_name = stabstr + stabs[i].n_strx;
296                 len = strfind(stab_fn_name, ':') - stab_fn_name;
297                 if (!len)
298                         continue;
299                 /* we have a match. */
300                 if (!strncmp(stab_fn_name, fn_name, len)) {
301                         printd("FN name: %s, Addr: %p\n", stab_fn_name, stabs[i].n_value);
302                         retval = (void*)stabs[i].n_value;
303                         break;
304                 }
305         }
306         return retval;
307 }
308
309 void backtrace(void)
310
311         extern char (SNT RO _start)[];
312         unsigned long *ebp, eip;
313         eipdebuginfo_t debuginfo;
314         char buf[256];
315         int j, i = 1;
316         ebp = (unsigned long*)read_bp();
317         // this is part of the way back into the call() instruction's bytes
318         // eagle-eyed readers should be able to explain why this is good enough,
319         // and retaddr (just *(ebp + 1) is not)
320         eip = *(ebp + 1) - 1;
321         // jump back a frame (out of backtrace)
322         ebp = (unsigned long*)(*ebp);
323         printk("Stack Backtrace on Core %d:\n", core_id());
324         // on each iteration, ebp holds the stack frame and eip an addr in that func
325         while (1) {
326                 debuginfo_eip(eip, &debuginfo);
327                 memset(buf, 0, 256);
328                 strncpy(buf, debuginfo.eip_fn_name, MIN(debuginfo.eip_fn_namelen, 256));
329                 buf[MIN(debuginfo.eip_fn_namelen, 255)] = 0;
330                 cprintf("#%02d [<%p>] in %s+%x(%p) from %s:%d\n", i++,  eip, buf, 
331                         debuginfo.eip_fn_addr - (uintptr_t)_start,
332                         debuginfo.eip_fn_addr, debuginfo.eip_file, debuginfo.eip_line);
333                 cprintf("    ebp: %x   Args:", ebp);
334                 for (j = 0; j < MIN(debuginfo.eip_fn_narg, 5); j++)
335                         cprintf(" %08x", *(ebp + 2 + j));
336                 cprintf("\n");
337                 if (!ebp)
338                         break;
339                 eip = *(ebp + 1) - 1;
340                 ebp = (unsigned long*)(*ebp);
341                 #ifdef CONFIG_RESET_STACKS
342                 if (!strncmp("__smp_idle", debuginfo.eip_fn_name, 10))
343                         break;
344                 #endif /* CONFIG_RESET_STACKS */
345         }
346 }
347
348 /* Assumes 32-bit header */
349 void print_fpu_state(struct ancillary_state *fpu)
350 {
351         printk("fcw:        0x%04x\n", fpu->fp_head_n64.fcw);
352         printk("fsw:        0x%04x\n", fpu->fp_head_n64.fsw);
353         printk("ftw:          0x%02x\n", fpu->fp_head_n64.ftw);
354         printk("fop:        0x%04x\n", fpu->fp_head_n64.fop);
355         printk("fpu_ip: 0x%08x\n", fpu->fp_head_n64.fpu_ip);
356         printk("cs:         0x%04x\n", fpu->fp_head_n64.cs);
357         printk("fpu_dp: 0x%08x\n", fpu->fp_head_n64.fpu_dp);
358         printk("ds:         0x%04x\n", fpu->fp_head_n64.ds);
359         printk("mxcsr:  0x%08x\n", fpu->fp_head_n64.mxcsr);
360         printk("mxcsrm: 0x%08x\n", fpu->fp_head_n64.mxcsr_mask);
361
362         for (int i = 0; i < sizeof(struct ancillary_state); i++) {
363                 if (i % 20 == 0)
364                         printk("\n");
365                 printk("%02x ", *((uint8_t*)fpu + i));
366         }
367         printk("\n");
368 }