[PATCH] Include documentation for functions in drivers/base/class.c
[usb.git] / kernel / unwind.c
blob3430475fcd886d011c01370a558e0a5965dd950d
1 /*
2 * Copyright (C) 2002-2006 Novell, Inc.
3 * Jan Beulich <jbeulich@novell.com>
4 * This code is released under version 2 of the GNU GPL.
6 * A simple API for unwinding kernel stacks. This is used for
7 * debugging and error reporting purposes. The kernel doesn't need
8 * full-blown stack unwinding with all the bells and whistles, so there
9 * is not much point in implementing the full Dwarf2 unwind API.
12 #include <linux/unwind.h>
13 #include <linux/module.h>
14 #include <linux/delay.h>
15 #include <linux/stop_machine.h>
16 #include <asm/sections.h>
17 #include <asm/uaccess.h>
18 #include <asm/unaligned.h>
20 extern char __start_unwind[], __end_unwind[];
22 #define MAX_STACK_DEPTH 8
24 #define EXTRA_INFO(f) { \
25 BUILD_BUG_ON_ZERO(offsetof(struct unwind_frame_info, f) \
26 % FIELD_SIZEOF(struct unwind_frame_info, f)) \
27 + offsetof(struct unwind_frame_info, f) \
28 / FIELD_SIZEOF(struct unwind_frame_info, f), \
29 FIELD_SIZEOF(struct unwind_frame_info, f) \
31 #define PTREGS_INFO(f) EXTRA_INFO(regs.f)
33 static const struct {
34 unsigned offs:BITS_PER_LONG / 2;
35 unsigned width:BITS_PER_LONG / 2;
36 } reg_info[] = {
37 UNW_REGISTER_INFO
40 #undef PTREGS_INFO
41 #undef EXTRA_INFO
43 #ifndef REG_INVALID
44 #define REG_INVALID(r) (reg_info[r].width == 0)
45 #endif
47 #define DW_CFA_nop 0x00
48 #define DW_CFA_set_loc 0x01
49 #define DW_CFA_advance_loc1 0x02
50 #define DW_CFA_advance_loc2 0x03
51 #define DW_CFA_advance_loc4 0x04
52 #define DW_CFA_offset_extended 0x05
53 #define DW_CFA_restore_extended 0x06
54 #define DW_CFA_undefined 0x07
55 #define DW_CFA_same_value 0x08
56 #define DW_CFA_register 0x09
57 #define DW_CFA_remember_state 0x0a
58 #define DW_CFA_restore_state 0x0b
59 #define DW_CFA_def_cfa 0x0c
60 #define DW_CFA_def_cfa_register 0x0d
61 #define DW_CFA_def_cfa_offset 0x0e
62 #define DW_CFA_def_cfa_expression 0x0f
63 #define DW_CFA_expression 0x10
64 #define DW_CFA_offset_extended_sf 0x11
65 #define DW_CFA_def_cfa_sf 0x12
66 #define DW_CFA_def_cfa_offset_sf 0x13
67 #define DW_CFA_val_offset 0x14
68 #define DW_CFA_val_offset_sf 0x15
69 #define DW_CFA_val_expression 0x16
70 #define DW_CFA_lo_user 0x1c
71 #define DW_CFA_GNU_window_save 0x2d
72 #define DW_CFA_GNU_args_size 0x2e
73 #define DW_CFA_GNU_negative_offset_extended 0x2f
74 #define DW_CFA_hi_user 0x3f
76 #define DW_EH_PE_FORM 0x07
77 #define DW_EH_PE_native 0x00
78 #define DW_EH_PE_leb128 0x01
79 #define DW_EH_PE_data2 0x02
80 #define DW_EH_PE_data4 0x03
81 #define DW_EH_PE_data8 0x04
82 #define DW_EH_PE_signed 0x08
83 #define DW_EH_PE_ADJUST 0x70
84 #define DW_EH_PE_abs 0x00
85 #define DW_EH_PE_pcrel 0x10
86 #define DW_EH_PE_textrel 0x20
87 #define DW_EH_PE_datarel 0x30
88 #define DW_EH_PE_funcrel 0x40
89 #define DW_EH_PE_aligned 0x50
90 #define DW_EH_PE_indirect 0x80
91 #define DW_EH_PE_omit 0xff
93 typedef unsigned long uleb128_t;
94 typedef signed long sleb128_t;
96 static struct unwind_table {
97 struct {
98 unsigned long pc;
99 unsigned long range;
100 } core, init;
101 const void *address;
102 unsigned long size;
103 struct unwind_table *link;
104 const char *name;
105 } root_table, *last_table;
107 struct unwind_item {
108 enum item_location {
109 Nowhere,
110 Memory,
111 Register,
112 Value
113 } where;
114 uleb128_t value;
117 struct unwind_state {
118 uleb128_t loc, org;
119 const u8 *cieStart, *cieEnd;
120 uleb128_t codeAlign;
121 sleb128_t dataAlign;
122 struct cfa {
123 uleb128_t reg, offs;
124 } cfa;
125 struct unwind_item regs[ARRAY_SIZE(reg_info)];
126 unsigned stackDepth:8;
127 unsigned version:8;
128 const u8 *label;
129 const u8 *stack[MAX_STACK_DEPTH];
132 static const struct cfa badCFA = { ARRAY_SIZE(reg_info), 1 };
134 static struct unwind_table *find_table(unsigned long pc)
136 struct unwind_table *table;
138 for (table = &root_table; table; table = table->link)
139 if ((pc >= table->core.pc
140 && pc < table->core.pc + table->core.range)
141 || (pc >= table->init.pc
142 && pc < table->init.pc + table->init.range))
143 break;
145 return table;
148 static void init_unwind_table(struct unwind_table *table,
149 const char *name,
150 const void *core_start,
151 unsigned long core_size,
152 const void *init_start,
153 unsigned long init_size,
154 const void *table_start,
155 unsigned long table_size)
157 table->core.pc = (unsigned long)core_start;
158 table->core.range = core_size;
159 table->init.pc = (unsigned long)init_start;
160 table->init.range = init_size;
161 table->address = table_start;
162 table->size = table_size;
163 table->link = NULL;
164 table->name = name;
167 void __init unwind_init(void)
169 init_unwind_table(&root_table, "kernel",
170 _text, _end - _text,
171 NULL, 0,
172 __start_unwind, __end_unwind - __start_unwind);
175 #ifdef CONFIG_MODULES
177 /* Must be called with module_mutex held. */
178 void *unwind_add_table(struct module *module,
179 const void *table_start,
180 unsigned long table_size)
182 struct unwind_table *table;
184 if (table_size <= 0)
185 return NULL;
187 table = kmalloc(sizeof(*table), GFP_KERNEL);
188 if (!table)
189 return NULL;
191 init_unwind_table(table, module->name,
192 module->module_core, module->core_size,
193 module->module_init, module->init_size,
194 table_start, table_size);
196 if (last_table)
197 last_table->link = table;
198 else
199 root_table.link = table;
200 last_table = table;
202 return table;
205 struct unlink_table_info
207 struct unwind_table *table;
208 int init_only;
211 static int unlink_table(void *arg)
213 struct unlink_table_info *info = arg;
214 struct unwind_table *table = info->table, *prev;
216 for (prev = &root_table; prev->link && prev->link != table; prev = prev->link)
219 if (prev->link) {
220 if (info->init_only) {
221 table->init.pc = 0;
222 table->init.range = 0;
223 info->table = NULL;
224 } else {
225 prev->link = table->link;
226 if (!prev->link)
227 last_table = prev;
229 } else
230 info->table = NULL;
232 return 0;
235 /* Must be called with module_mutex held. */
236 void unwind_remove_table(void *handle, int init_only)
238 struct unwind_table *table = handle;
239 struct unlink_table_info info;
241 if (!table || table == &root_table)
242 return;
244 if (init_only && table == last_table) {
245 table->init.pc = 0;
246 table->init.range = 0;
247 return;
250 info.table = table;
251 info.init_only = init_only;
252 stop_machine_run(unlink_table, &info, NR_CPUS);
254 if (info.table)
255 kfree(table);
258 #endif /* CONFIG_MODULES */
260 static uleb128_t get_uleb128(const u8 **pcur, const u8 *end)
262 const u8 *cur = *pcur;
263 uleb128_t value;
264 unsigned shift;
266 for (shift = 0, value = 0; cur < end; shift += 7) {
267 if (shift + 7 > 8 * sizeof(value)
268 && (*cur & 0x7fU) >= (1U << (8 * sizeof(value) - shift))) {
269 cur = end + 1;
270 break;
272 value |= (uleb128_t)(*cur & 0x7f) << shift;
273 if (!(*cur++ & 0x80))
274 break;
276 *pcur = cur;
278 return value;
281 static sleb128_t get_sleb128(const u8 **pcur, const u8 *end)
283 const u8 *cur = *pcur;
284 sleb128_t value;
285 unsigned shift;
287 for (shift = 0, value = 0; cur < end; shift += 7) {
288 if (shift + 7 > 8 * sizeof(value)
289 && (*cur & 0x7fU) >= (1U << (8 * sizeof(value) - shift))) {
290 cur = end + 1;
291 break;
293 value |= (sleb128_t)(*cur & 0x7f) << shift;
294 if (!(*cur & 0x80)) {
295 value |= -(*cur++ & 0x40) << shift;
296 break;
299 *pcur = cur;
301 return value;
304 static unsigned long read_pointer(const u8 **pLoc,
305 const void *end,
306 signed ptrType)
308 unsigned long value = 0;
309 union {
310 const u8 *p8;
311 const u16 *p16u;
312 const s16 *p16s;
313 const u32 *p32u;
314 const s32 *p32s;
315 const unsigned long *pul;
316 } ptr;
318 if (ptrType < 0 || ptrType == DW_EH_PE_omit)
319 return 0;
320 ptr.p8 = *pLoc;
321 switch(ptrType & DW_EH_PE_FORM) {
322 case DW_EH_PE_data2:
323 if (end < (const void *)(ptr.p16u + 1))
324 return 0;
325 if(ptrType & DW_EH_PE_signed)
326 value = get_unaligned(ptr.p16s++);
327 else
328 value = get_unaligned(ptr.p16u++);
329 break;
330 case DW_EH_PE_data4:
331 #ifdef CONFIG_64BIT
332 if (end < (const void *)(ptr.p32u + 1))
333 return 0;
334 if(ptrType & DW_EH_PE_signed)
335 value = get_unaligned(ptr.p32s++);
336 else
337 value = get_unaligned(ptr.p32u++);
338 break;
339 case DW_EH_PE_data8:
340 BUILD_BUG_ON(sizeof(u64) != sizeof(value));
341 #else
342 BUILD_BUG_ON(sizeof(u32) != sizeof(value));
343 #endif
344 case DW_EH_PE_native:
345 if (end < (const void *)(ptr.pul + 1))
346 return 0;
347 value = get_unaligned(ptr.pul++);
348 break;
349 case DW_EH_PE_leb128:
350 BUILD_BUG_ON(sizeof(uleb128_t) > sizeof(value));
351 value = ptrType & DW_EH_PE_signed
352 ? get_sleb128(&ptr.p8, end)
353 : get_uleb128(&ptr.p8, end);
354 if ((const void *)ptr.p8 > end)
355 return 0;
356 break;
357 default:
358 return 0;
360 switch(ptrType & DW_EH_PE_ADJUST) {
361 case DW_EH_PE_abs:
362 break;
363 case DW_EH_PE_pcrel:
364 value += (unsigned long)*pLoc;
365 break;
366 default:
367 return 0;
369 if ((ptrType & DW_EH_PE_indirect)
370 && __get_user(value, (unsigned long *)value))
371 return 0;
372 *pLoc = ptr.p8;
374 return value;
377 static signed fde_pointer_type(const u32 *cie)
379 const u8 *ptr = (const u8 *)(cie + 2);
380 unsigned version = *ptr;
382 if (version != 1)
383 return -1; /* unsupported */
384 if (*++ptr) {
385 const char *aug;
386 const u8 *end = (const u8 *)(cie + 1) + *cie;
387 uleb128_t len;
389 /* check if augmentation size is first (and thus present) */
390 if (*ptr != 'z')
391 return -1;
392 /* check if augmentation string is nul-terminated */
393 if ((ptr = memchr(aug = (const void *)ptr, 0, end - ptr)) == NULL)
394 return -1;
395 ++ptr; /* skip terminator */
396 get_uleb128(&ptr, end); /* skip code alignment */
397 get_sleb128(&ptr, end); /* skip data alignment */
398 /* skip return address column */
399 version <= 1 ? (void)++ptr : (void)get_uleb128(&ptr, end);
400 len = get_uleb128(&ptr, end); /* augmentation length */
401 if (ptr + len < ptr || ptr + len > end)
402 return -1;
403 end = ptr + len;
404 while (*++aug) {
405 if (ptr >= end)
406 return -1;
407 switch(*aug) {
408 case 'L':
409 ++ptr;
410 break;
411 case 'P': {
412 signed ptrType = *ptr++;
414 if (!read_pointer(&ptr, end, ptrType) || ptr > end)
415 return -1;
417 break;
418 case 'R':
419 return *ptr;
420 default:
421 return -1;
425 return DW_EH_PE_native|DW_EH_PE_abs;
428 static int advance_loc(unsigned long delta, struct unwind_state *state)
430 state->loc += delta * state->codeAlign;
432 return delta > 0;
435 static void set_rule(uleb128_t reg,
436 enum item_location where,
437 uleb128_t value,
438 struct unwind_state *state)
440 if (reg < ARRAY_SIZE(state->regs)) {
441 state->regs[reg].where = where;
442 state->regs[reg].value = value;
446 static int processCFI(const u8 *start,
447 const u8 *end,
448 unsigned long targetLoc,
449 signed ptrType,
450 struct unwind_state *state)
452 union {
453 const u8 *p8;
454 const u16 *p16;
455 const u32 *p32;
456 } ptr;
457 int result = 1;
459 if (start != state->cieStart) {
460 state->loc = state->org;
461 result = processCFI(state->cieStart, state->cieEnd, 0, ptrType, state);
462 if (targetLoc == 0 && state->label == NULL)
463 return result;
465 for (ptr.p8 = start; result && ptr.p8 < end; ) {
466 switch(*ptr.p8 >> 6) {
467 uleb128_t value;
469 case 0:
470 switch(*ptr.p8++) {
471 case DW_CFA_nop:
472 break;
473 case DW_CFA_set_loc:
474 if ((state->loc = read_pointer(&ptr.p8, end, ptrType)) == 0)
475 result = 0;
476 break;
477 case DW_CFA_advance_loc1:
478 result = ptr.p8 < end && advance_loc(*ptr.p8++, state);
479 break;
480 case DW_CFA_advance_loc2:
481 result = ptr.p8 <= end + 2
482 && advance_loc(*ptr.p16++, state);
483 break;
484 case DW_CFA_advance_loc4:
485 result = ptr.p8 <= end + 4
486 && advance_loc(*ptr.p32++, state);
487 break;
488 case DW_CFA_offset_extended:
489 value = get_uleb128(&ptr.p8, end);
490 set_rule(value, Memory, get_uleb128(&ptr.p8, end), state);
491 break;
492 case DW_CFA_val_offset:
493 value = get_uleb128(&ptr.p8, end);
494 set_rule(value, Value, get_uleb128(&ptr.p8, end), state);
495 break;
496 case DW_CFA_offset_extended_sf:
497 value = get_uleb128(&ptr.p8, end);
498 set_rule(value, Memory, get_sleb128(&ptr.p8, end), state);
499 break;
500 case DW_CFA_val_offset_sf:
501 value = get_uleb128(&ptr.p8, end);
502 set_rule(value, Value, get_sleb128(&ptr.p8, end), state);
503 break;
504 case DW_CFA_restore_extended:
505 case DW_CFA_undefined:
506 case DW_CFA_same_value:
507 set_rule(get_uleb128(&ptr.p8, end), Nowhere, 0, state);
508 break;
509 case DW_CFA_register:
510 value = get_uleb128(&ptr.p8, end);
511 set_rule(value,
512 Register,
513 get_uleb128(&ptr.p8, end), state);
514 break;
515 case DW_CFA_remember_state:
516 if (ptr.p8 == state->label) {
517 state->label = NULL;
518 return 1;
520 if (state->stackDepth >= MAX_STACK_DEPTH)
521 return 0;
522 state->stack[state->stackDepth++] = ptr.p8;
523 break;
524 case DW_CFA_restore_state:
525 if (state->stackDepth) {
526 const uleb128_t loc = state->loc;
527 const u8 *label = state->label;
529 state->label = state->stack[state->stackDepth - 1];
530 memcpy(&state->cfa, &badCFA, sizeof(state->cfa));
531 memset(state->regs, 0, sizeof(state->regs));
532 state->stackDepth = 0;
533 result = processCFI(start, end, 0, ptrType, state);
534 state->loc = loc;
535 state->label = label;
536 } else
537 return 0;
538 break;
539 case DW_CFA_def_cfa:
540 state->cfa.reg = get_uleb128(&ptr.p8, end);
541 /*nobreak*/
542 case DW_CFA_def_cfa_offset:
543 state->cfa.offs = get_uleb128(&ptr.p8, end);
544 break;
545 case DW_CFA_def_cfa_sf:
546 state->cfa.reg = get_uleb128(&ptr.p8, end);
547 /*nobreak*/
548 case DW_CFA_def_cfa_offset_sf:
549 state->cfa.offs = get_sleb128(&ptr.p8, end)
550 * state->dataAlign;
551 break;
552 case DW_CFA_def_cfa_register:
553 state->cfa.reg = get_uleb128(&ptr.p8, end);
554 break;
555 /*todo case DW_CFA_def_cfa_expression: */
556 /*todo case DW_CFA_expression: */
557 /*todo case DW_CFA_val_expression: */
558 case DW_CFA_GNU_args_size:
559 get_uleb128(&ptr.p8, end);
560 break;
561 case DW_CFA_GNU_negative_offset_extended:
562 value = get_uleb128(&ptr.p8, end);
563 set_rule(value,
564 Memory,
565 (uleb128_t)0 - get_uleb128(&ptr.p8, end), state);
566 break;
567 case DW_CFA_GNU_window_save:
568 default:
569 result = 0;
570 break;
572 break;
573 case 1:
574 result = advance_loc(*ptr.p8++ & 0x3f, state);
575 break;
576 case 2:
577 value = *ptr.p8++ & 0x3f;
578 set_rule(value, Memory, get_uleb128(&ptr.p8, end), state);
579 break;
580 case 3:
581 set_rule(*ptr.p8++ & 0x3f, Nowhere, 0, state);
582 break;
584 if (ptr.p8 > end)
585 result = 0;
586 if (result && targetLoc != 0 && targetLoc < state->loc)
587 return 1;
590 return result
591 && ptr.p8 == end
592 && (targetLoc == 0
593 || (/*todo While in theory this should apply, gcc in practice omits
594 everything past the function prolog, and hence the location
595 never reaches the end of the function.
596 targetLoc < state->loc &&*/ state->label == NULL));
599 /* Unwind to previous to frame. Returns 0 if successful, negative
600 * number in case of an error. */
601 int unwind(struct unwind_frame_info *frame)
603 #define FRAME_REG(r, t) (((t *)frame)[reg_info[r].offs])
604 const u32 *fde = NULL, *cie = NULL;
605 const u8 *ptr = NULL, *end = NULL;
606 unsigned long pc = UNW_PC(frame) - frame->call_frame;
607 unsigned long startLoc = 0, endLoc = 0, cfa;
608 unsigned i;
609 signed ptrType = -1;
610 uleb128_t retAddrReg = 0;
611 struct unwind_table *table;
612 struct unwind_state state;
614 if (UNW_PC(frame) == 0)
615 return -EINVAL;
616 if ((table = find_table(pc)) != NULL
617 && !(table->size & (sizeof(*fde) - 1))) {
618 unsigned long tableSize = table->size;
620 for (fde = table->address;
621 tableSize > sizeof(*fde) && tableSize - sizeof(*fde) >= *fde;
622 tableSize -= sizeof(*fde) + *fde,
623 fde += 1 + *fde / sizeof(*fde)) {
624 if (!*fde || (*fde & (sizeof(*fde) - 1)))
625 break;
626 if (!fde[1])
627 continue; /* this is a CIE */
628 if ((fde[1] & (sizeof(*fde) - 1))
629 || fde[1] > (unsigned long)(fde + 1)
630 - (unsigned long)table->address)
631 continue; /* this is not a valid FDE */
632 cie = fde + 1 - fde[1] / sizeof(*fde);
633 if (*cie <= sizeof(*cie) + 4
634 || *cie >= fde[1] - sizeof(*fde)
635 || (*cie & (sizeof(*cie) - 1))
636 || cie[1]
637 || (ptrType = fde_pointer_type(cie)) < 0) {
638 cie = NULL; /* this is not a (valid) CIE */
639 continue;
641 ptr = (const u8 *)(fde + 2);
642 startLoc = read_pointer(&ptr,
643 (const u8 *)(fde + 1) + *fde,
644 ptrType);
645 endLoc = startLoc
646 + read_pointer(&ptr,
647 (const u8 *)(fde + 1) + *fde,
648 ptrType & DW_EH_PE_indirect
649 ? ptrType
650 : ptrType & (DW_EH_PE_FORM|DW_EH_PE_signed));
651 if (pc >= startLoc && pc < endLoc)
652 break;
653 cie = NULL;
656 if (cie != NULL) {
657 memset(&state, 0, sizeof(state));
658 state.cieEnd = ptr; /* keep here temporarily */
659 ptr = (const u8 *)(cie + 2);
660 end = (const u8 *)(cie + 1) + *cie;
661 frame->call_frame = 1;
662 if ((state.version = *ptr) != 1)
663 cie = NULL; /* unsupported version */
664 else if (*++ptr) {
665 /* check if augmentation size is first (and thus present) */
666 if (*ptr == 'z') {
667 while (++ptr < end && *ptr) {
668 switch(*ptr) {
669 /* check for ignorable (or already handled)
670 * nul-terminated augmentation string */
671 case 'L':
672 case 'P':
673 case 'R':
674 continue;
675 case 'S':
676 frame->call_frame = 0;
677 continue;
678 default:
679 break;
681 break;
684 if (ptr >= end || *ptr)
685 cie = NULL;
687 ++ptr;
689 if (cie != NULL) {
690 /* get code aligment factor */
691 state.codeAlign = get_uleb128(&ptr, end);
692 /* get data aligment factor */
693 state.dataAlign = get_sleb128(&ptr, end);
694 if (state.codeAlign == 0 || state.dataAlign == 0 || ptr >= end)
695 cie = NULL;
696 else {
697 retAddrReg = state.version <= 1 ? *ptr++ : get_uleb128(&ptr, end);
698 /* skip augmentation */
699 if (((const char *)(cie + 2))[1] == 'z')
700 ptr += get_uleb128(&ptr, end);
701 if (ptr > end
702 || retAddrReg >= ARRAY_SIZE(reg_info)
703 || REG_INVALID(retAddrReg)
704 || reg_info[retAddrReg].width != sizeof(unsigned long))
705 cie = NULL;
708 if (cie != NULL) {
709 state.cieStart = ptr;
710 ptr = state.cieEnd;
711 state.cieEnd = end;
712 end = (const u8 *)(fde + 1) + *fde;
713 /* skip augmentation */
714 if (((const char *)(cie + 2))[1] == 'z') {
715 uleb128_t augSize = get_uleb128(&ptr, end);
717 if ((ptr += augSize) > end)
718 fde = NULL;
721 if (cie == NULL || fde == NULL) {
722 #ifdef CONFIG_FRAME_POINTER
723 unsigned long top, bottom;
724 #endif
726 #ifdef CONFIG_FRAME_POINTER
727 top = STACK_TOP(frame->task);
728 bottom = STACK_BOTTOM(frame->task);
729 # if FRAME_RETADDR_OFFSET < 0
730 if (UNW_SP(frame) < top
731 && UNW_FP(frame) <= UNW_SP(frame)
732 && bottom < UNW_FP(frame)
733 # else
734 if (UNW_SP(frame) > top
735 && UNW_FP(frame) >= UNW_SP(frame)
736 && bottom > UNW_FP(frame)
737 # endif
738 && !((UNW_SP(frame) | UNW_FP(frame))
739 & (sizeof(unsigned long) - 1))) {
740 unsigned long link;
742 if (!__get_user(link,
743 (unsigned long *)(UNW_FP(frame)
744 + FRAME_LINK_OFFSET))
745 # if FRAME_RETADDR_OFFSET < 0
746 && link > bottom && link < UNW_FP(frame)
747 # else
748 && link > UNW_FP(frame) && link < bottom
749 # endif
750 && !(link & (sizeof(link) - 1))
751 && !__get_user(UNW_PC(frame),
752 (unsigned long *)(UNW_FP(frame)
753 + FRAME_RETADDR_OFFSET))) {
754 UNW_SP(frame) = UNW_FP(frame) + FRAME_RETADDR_OFFSET
755 # if FRAME_RETADDR_OFFSET < 0
757 # else
759 # endif
760 sizeof(UNW_PC(frame));
761 UNW_FP(frame) = link;
762 return 0;
765 #endif
766 return -ENXIO;
768 state.org = startLoc;
769 memcpy(&state.cfa, &badCFA, sizeof(state.cfa));
770 /* process instructions */
771 if (!processCFI(ptr, end, pc, ptrType, &state)
772 || state.loc > endLoc
773 || state.regs[retAddrReg].where == Nowhere
774 || state.cfa.reg >= ARRAY_SIZE(reg_info)
775 || reg_info[state.cfa.reg].width != sizeof(unsigned long)
776 || state.cfa.offs % sizeof(unsigned long))
777 return -EIO;
778 /* update frame */
779 #ifndef CONFIG_AS_CFI_SIGNAL_FRAME
780 if(frame->call_frame
781 && !UNW_DEFAULT_RA(state.regs[retAddrReg], state.dataAlign))
782 frame->call_frame = 0;
783 #endif
784 cfa = FRAME_REG(state.cfa.reg, unsigned long) + state.cfa.offs;
785 startLoc = min((unsigned long)UNW_SP(frame), cfa);
786 endLoc = max((unsigned long)UNW_SP(frame), cfa);
787 if (STACK_LIMIT(startLoc) != STACK_LIMIT(endLoc)) {
788 startLoc = min(STACK_LIMIT(cfa), cfa);
789 endLoc = max(STACK_LIMIT(cfa), cfa);
791 #ifndef CONFIG_64BIT
792 # define CASES CASE(8); CASE(16); CASE(32)
793 #else
794 # define CASES CASE(8); CASE(16); CASE(32); CASE(64)
795 #endif
796 for (i = 0; i < ARRAY_SIZE(state.regs); ++i) {
797 if (REG_INVALID(i)) {
798 if (state.regs[i].where == Nowhere)
799 continue;
800 return -EIO;
802 switch(state.regs[i].where) {
803 default:
804 break;
805 case Register:
806 if (state.regs[i].value >= ARRAY_SIZE(reg_info)
807 || REG_INVALID(state.regs[i].value)
808 || reg_info[i].width > reg_info[state.regs[i].value].width)
809 return -EIO;
810 switch(reg_info[state.regs[i].value].width) {
811 #define CASE(n) \
812 case sizeof(u##n): \
813 state.regs[i].value = FRAME_REG(state.regs[i].value, \
814 const u##n); \
815 break
816 CASES;
817 #undef CASE
818 default:
819 return -EIO;
821 break;
824 for (i = 0; i < ARRAY_SIZE(state.regs); ++i) {
825 if (REG_INVALID(i))
826 continue;
827 switch(state.regs[i].where) {
828 case Nowhere:
829 if (reg_info[i].width != sizeof(UNW_SP(frame))
830 || &FRAME_REG(i, __typeof__(UNW_SP(frame)))
831 != &UNW_SP(frame))
832 continue;
833 UNW_SP(frame) = cfa;
834 break;
835 case Register:
836 switch(reg_info[i].width) {
837 #define CASE(n) case sizeof(u##n): \
838 FRAME_REG(i, u##n) = state.regs[i].value; \
839 break
840 CASES;
841 #undef CASE
842 default:
843 return -EIO;
845 break;
846 case Value:
847 if (reg_info[i].width != sizeof(unsigned long))
848 return -EIO;
849 FRAME_REG(i, unsigned long) = cfa + state.regs[i].value
850 * state.dataAlign;
851 break;
852 case Memory: {
853 unsigned long addr = cfa + state.regs[i].value
854 * state.dataAlign;
856 if ((state.regs[i].value * state.dataAlign)
857 % sizeof(unsigned long)
858 || addr < startLoc
859 || addr + sizeof(unsigned long) < addr
860 || addr + sizeof(unsigned long) > endLoc)
861 return -EIO;
862 switch(reg_info[i].width) {
863 #define CASE(n) case sizeof(u##n): \
864 __get_user(FRAME_REG(i, u##n), (u##n *)addr); \
865 break
866 CASES;
867 #undef CASE
868 default:
869 return -EIO;
872 break;
876 return 0;
877 #undef CASES
878 #undef FRAME_REG
880 EXPORT_SYMBOL(unwind);
882 int unwind_init_frame_info(struct unwind_frame_info *info,
883 struct task_struct *tsk,
884 /*const*/ struct pt_regs *regs)
886 info->task = tsk;
887 info->call_frame = 0;
888 arch_unw_init_frame_info(info, regs);
890 return 0;
892 EXPORT_SYMBOL(unwind_init_frame_info);
895 * Prepare to unwind a blocked task.
897 int unwind_init_blocked(struct unwind_frame_info *info,
898 struct task_struct *tsk)
900 info->task = tsk;
901 info->call_frame = 0;
902 arch_unw_init_blocked(info);
904 return 0;
906 EXPORT_SYMBOL(unwind_init_blocked);
909 * Prepare to unwind the currently running thread.
911 int unwind_init_running(struct unwind_frame_info *info,
912 asmlinkage int (*callback)(struct unwind_frame_info *,
913 void *arg),
914 void *arg)
916 info->task = current;
917 info->call_frame = 0;
919 return arch_unwind_init_running(info, callback, arg);
921 EXPORT_SYMBOL(unwind_init_running);
924 * Unwind until the return pointer is in user-land (or until an error
925 * occurs). Returns 0 if successful, negative number in case of
926 * error.
928 int unwind_to_user(struct unwind_frame_info *info)
930 while (!arch_unw_user_mode(info)) {
931 int err = unwind(info);
933 if (err < 0)
934 return err;
937 return 0;
939 EXPORT_SYMBOL(unwind_to_user);