| 1 |
|
| 2 | #ifndef _KSTACK_H
|
| 3 | #define _KSTACK_H
|
| 4 |
|
| 5 | #include <linux/thread_info.h>
|
| 6 | #include <linux/sched.h>
|
| 7 | #include <asm/ptrace.h>
|
| 8 | #include <asm/irq.h>
|
| 9 |
|
| 10 |
|
| 11 | static inline bool kstack_valid(struct thread_info *tp, unsigned long sp)
|
| 12 | {
|
| 13 | unsigned long base = (unsigned long) tp;
|
| 14 |
|
| 15 |
|
| 16 | if (sp & (16UL - 1))
|
| 17 | return false;
|
| 18 |
|
| 19 | if (sp >= (base + sizeof(struct thread_info)) &&
|
| 20 | sp <= (base + THREAD_SIZE - sizeof(struct sparc_stackf)))
|
| 21 | return true;
|
| 22 |
|
| 23 | if (hardirq_stack[tp->cpu]) {
|
| 24 | base = (unsigned long) hardirq_stack[tp->cpu];
|
| 25 | if (sp >= base &&
|
| 26 | sp <= (base + THREAD_SIZE - sizeof(struct sparc_stackf)))
|
| 27 | return true;
|
| 28 | base = (unsigned long) softirq_stack[tp->cpu];
|
| 29 | if (sp >= base &&
|
| 30 | sp <= (base + THREAD_SIZE - sizeof(struct sparc_stackf)))
|
| 31 | return true;
|
| 32 | }
|
| 33 | return false;
|
| 34 | }
|
| 35 |
|
| 36 |
|
| 37 | static inline bool kstack_is_trap_frame(struct thread_info *tp, struct pt_regs *regs)
|
| 38 | {
|
| 39 | unsigned long base = (unsigned long) tp;
|
| 40 | unsigned long addr = (unsigned long) regs;
|
| 41 |
|
| 42 | if (addr >= base &&
|
| 43 | addr <= (base + THREAD_SIZE - sizeof(*regs)))
|
| 44 | goto check_magic;
|
| 45 |
|
| 46 | if (hardirq_stack[tp->cpu]) {
|
| 47 | base = (unsigned long) hardirq_stack[tp->cpu];
|
| 48 | if (addr >= base &&
|
| 49 | addr <= (base + THREAD_SIZE - sizeof(*regs)))
|
| 50 | goto check_magic;
|
| 51 | base = (unsigned long) softirq_stack[tp->cpu];
|
| 52 | if (addr >= base &&
|
| 53 | addr <= (base + THREAD_SIZE - sizeof(*regs)))
|
| 54 | goto check_magic;
|
| 55 | }
|
| 56 | return false;
|
| 57 |
|
| 58 | check_magic:
|
| 59 | if ((regs->magic & ~0x1ff) == PT_REGS_MAGIC)
|
| 60 | return true;
|
| 61 | return false;
|
| 62 |
|
| 63 | }
|
| 64 |
|
| 65 | static inline __attribute__((always_inline)) void *set_hardirq_stack(void)
|
| 66 | {
|
| 67 | void *orig_sp, *sp = hardirq_stack[smp_processor_id()];
|
| 68 |
|
| 69 | __asm__ __volatile__("mov %%sp, %0" : "=r" (orig_sp));
|
| 70 | if (orig_sp < sp ||
|
| 71 | orig_sp > (sp + THREAD_SIZE)) {
|
| 72 | sp += THREAD_SIZE - 192 - STACK_BIAS;
|
| 73 | __asm__ __volatile__("mov %0, %%sp" : : "r" (sp));
|
| 74 | }
|
| 75 |
|
| 76 | return orig_sp;
|
| 77 | }
|
| 78 |
|
| 79 | static inline __attribute__((always_inline)) void restore_hardirq_stack(void *orig_sp)
|
| 80 | {
|
| 81 | __asm__ __volatile__("mov %0, %%sp" : : "r" (orig_sp));
|
| 82 | }
|
| 83 |
|
| 84 | #endif
|