| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | * This file is subject to the terms and conditions of the GNU General Public | 
|  | 3 | * License.  See the file "COPYING" in the main directory of this archive | 
|  | 4 | * for more details. | 
|  | 5 | * | 
|  | 6 | * Copyright (C) 1991, 1992  Linus Torvalds | 
|  | 7 | * Copyright (C) 1994 - 2000  Ralf Baechle | 
|  | 8 | * Copyright (C) 1999, 2000 Silicon Graphics, Inc. | 
|  | 9 | */ | 
|  | 10 |  | 
| Ralf Baechle | e50c0a8f | 2005-05-31 11:49:19 +0000 | [diff] [blame] | 11 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 12 | static inline int | 
| Atsushi Nemoto | 9bbf28a3 | 2006-02-01 01:41:09 +0900 | [diff] [blame] | 13 | setup_sigcontext(struct pt_regs *regs, struct sigcontext __user *sc) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 14 | { | 
|  | 15 | int err = 0; | 
|  | 16 |  | 
|  | 17 | err |= __put_user(regs->cp0_epc, &sc->sc_pc); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 18 |  | 
|  | 19 | #define save_gp_reg(i) do {						\ | 
|  | 20 | err |= __put_user(regs->regs[i], &sc->sc_regs[i]);		\ | 
|  | 21 | } while(0) | 
|  | 22 | __put_user(0, &sc->sc_regs[0]); save_gp_reg(1); save_gp_reg(2); | 
|  | 23 | save_gp_reg(3); save_gp_reg(4); save_gp_reg(5); save_gp_reg(6); | 
|  | 24 | save_gp_reg(7); save_gp_reg(8); save_gp_reg(9); save_gp_reg(10); | 
|  | 25 | save_gp_reg(11); save_gp_reg(12); save_gp_reg(13); save_gp_reg(14); | 
|  | 26 | save_gp_reg(15); save_gp_reg(16); save_gp_reg(17); save_gp_reg(18); | 
|  | 27 | save_gp_reg(19); save_gp_reg(20); save_gp_reg(21); save_gp_reg(22); | 
|  | 28 | save_gp_reg(23); save_gp_reg(24); save_gp_reg(25); save_gp_reg(26); | 
|  | 29 | save_gp_reg(27); save_gp_reg(28); save_gp_reg(29); save_gp_reg(30); | 
|  | 30 | save_gp_reg(31); | 
|  | 31 | #undef save_gp_reg | 
|  | 32 |  | 
|  | 33 | err |= __put_user(regs->hi, &sc->sc_mdhi); | 
|  | 34 | err |= __put_user(regs->lo, &sc->sc_mdlo); | 
| Ralf Baechle | e50c0a8f | 2005-05-31 11:49:19 +0000 | [diff] [blame] | 35 | if (cpu_has_dsp) { | 
|  | 36 | err |= __put_user(mfhi1(), &sc->sc_hi1); | 
|  | 37 | err |= __put_user(mflo1(), &sc->sc_lo1); | 
|  | 38 | err |= __put_user(mfhi2(), &sc->sc_hi2); | 
|  | 39 | err |= __put_user(mflo2(), &sc->sc_lo2); | 
|  | 40 | err |= __put_user(mfhi3(), &sc->sc_hi3); | 
|  | 41 | err |= __put_user(mflo3(), &sc->sc_lo3); | 
|  | 42 | err |= __put_user(rddsp(DSP_MASK), &sc->sc_dsp); | 
|  | 43 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 44 |  | 
|  | 45 | err |= __put_user(!!used_math(), &sc->sc_used_math); | 
|  | 46 |  | 
|  | 47 | if (!used_math()) | 
|  | 48 | goto out; | 
|  | 49 |  | 
|  | 50 | /* | 
|  | 51 | * Save FPU state to signal context.  Signal handler will "inherit" | 
|  | 52 | * current FPU state. | 
|  | 53 | */ | 
|  | 54 | preempt_disable(); | 
|  | 55 |  | 
|  | 56 | if (!is_fpu_owner()) { | 
|  | 57 | own_fpu(); | 
|  | 58 | restore_fp(current); | 
|  | 59 | } | 
|  | 60 | err |= save_fp_context(sc); | 
|  | 61 |  | 
|  | 62 | preempt_enable(); | 
|  | 63 |  | 
|  | 64 | out: | 
|  | 65 | return err; | 
|  | 66 | } | 
|  | 67 |  | 
|  | 68 | static inline int | 
| Atsushi Nemoto | 9bbf28a3 | 2006-02-01 01:41:09 +0900 | [diff] [blame] | 69 | restore_sigcontext(struct pt_regs *regs, struct sigcontext __user *sc) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 70 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 71 | unsigned int used_math; | 
| Ralf Baechle | e50c0a8f | 2005-05-31 11:49:19 +0000 | [diff] [blame] | 72 | unsigned long treg; | 
|  | 73 | int err = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 74 |  | 
|  | 75 | /* Always make any pending restarted system calls return -EINTR */ | 
|  | 76 | current_thread_info()->restart_block.fn = do_no_restart_syscall; | 
|  | 77 |  | 
|  | 78 | err |= __get_user(regs->cp0_epc, &sc->sc_pc); | 
|  | 79 | err |= __get_user(regs->hi, &sc->sc_mdhi); | 
|  | 80 | err |= __get_user(regs->lo, &sc->sc_mdlo); | 
| Ralf Baechle | e50c0a8f | 2005-05-31 11:49:19 +0000 | [diff] [blame] | 81 | if (cpu_has_dsp) { | 
|  | 82 | err |= __get_user(treg, &sc->sc_hi1); mthi1(treg); | 
|  | 83 | err |= __get_user(treg, &sc->sc_lo1); mtlo1(treg); | 
|  | 84 | err |= __get_user(treg, &sc->sc_hi2); mthi2(treg); | 
|  | 85 | err |= __get_user(treg, &sc->sc_lo2); mtlo2(treg); | 
|  | 86 | err |= __get_user(treg, &sc->sc_hi3); mthi3(treg); | 
|  | 87 | err |= __get_user(treg, &sc->sc_lo3); mtlo3(treg); | 
|  | 88 | err |= __get_user(treg, &sc->sc_dsp); wrdsp(treg, DSP_MASK); | 
|  | 89 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 90 |  | 
|  | 91 | #define restore_gp_reg(i) do {						\ | 
|  | 92 | err |= __get_user(regs->regs[i], &sc->sc_regs[i]);		\ | 
|  | 93 | } while(0) | 
|  | 94 | restore_gp_reg( 1); restore_gp_reg( 2); restore_gp_reg( 3); | 
|  | 95 | restore_gp_reg( 4); restore_gp_reg( 5); restore_gp_reg( 6); | 
|  | 96 | restore_gp_reg( 7); restore_gp_reg( 8); restore_gp_reg( 9); | 
|  | 97 | restore_gp_reg(10); restore_gp_reg(11); restore_gp_reg(12); | 
|  | 98 | restore_gp_reg(13); restore_gp_reg(14); restore_gp_reg(15); | 
|  | 99 | restore_gp_reg(16); restore_gp_reg(17); restore_gp_reg(18); | 
|  | 100 | restore_gp_reg(19); restore_gp_reg(20); restore_gp_reg(21); | 
|  | 101 | restore_gp_reg(22); restore_gp_reg(23); restore_gp_reg(24); | 
|  | 102 | restore_gp_reg(25); restore_gp_reg(26); restore_gp_reg(27); | 
|  | 103 | restore_gp_reg(28); restore_gp_reg(29); restore_gp_reg(30); | 
|  | 104 | restore_gp_reg(31); | 
|  | 105 | #undef restore_gp_reg | 
|  | 106 |  | 
|  | 107 | err |= __get_user(used_math, &sc->sc_used_math); | 
|  | 108 | conditional_used_math(used_math); | 
|  | 109 |  | 
|  | 110 | preempt_disable(); | 
|  | 111 |  | 
|  | 112 | if (used_math()) { | 
|  | 113 | /* restore fpu context if we have used it before */ | 
|  | 114 | own_fpu(); | 
|  | 115 | err |= restore_fp_context(sc); | 
|  | 116 | } else { | 
|  | 117 | /* signal handler may have used FPU.  Give it up. */ | 
|  | 118 | lose_fpu(); | 
|  | 119 | } | 
|  | 120 |  | 
|  | 121 | preempt_enable(); | 
|  | 122 |  | 
|  | 123 | return err; | 
|  | 124 | } | 
|  | 125 |  | 
|  | 126 | /* | 
|  | 127 | * Determine which stack to use.. | 
|  | 128 | */ | 
| Atsushi Nemoto | 9bbf28a3 | 2006-02-01 01:41:09 +0900 | [diff] [blame] | 129 | static inline void __user * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 130 | get_sigframe(struct k_sigaction *ka, struct pt_regs *regs, size_t frame_size) | 
|  | 131 | { | 
| Ralf Baechle | 02416dc | 2005-06-15 13:00:12 +0000 | [diff] [blame] | 132 | unsigned long sp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 133 |  | 
|  | 134 | /* Default to using normal stack */ | 
|  | 135 | sp = regs->regs[29]; | 
|  | 136 |  | 
|  | 137 | /* | 
| Ralf Baechle | a3dddd5 | 2006-03-11 08:18:41 +0000 | [diff] [blame] | 138 | * FPU emulator may have it's own trampoline active just | 
|  | 139 | * above the user stack, 16-bytes before the next lowest | 
|  | 140 | * 16 byte boundary.  Try to avoid trashing it. | 
|  | 141 | */ | 
|  | 142 | sp -= 32; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 143 |  | 
|  | 144 | /* This is the X/Open sanctioned signal stack switching.  */ | 
|  | 145 | if ((ka->sa.sa_flags & SA_ONSTACK) && (sas_ss_flags (sp) == 0)) | 
|  | 146 | sp = current->sas_ss_sp + current->sas_ss_size; | 
|  | 147 |  | 
| Thomas Koeller | 387a154 | 2006-02-10 17:36:27 +0100 | [diff] [blame] | 148 | return (void __user *)((sp - frame_size) & (ICACHE_REFILLS_WORKAROUND_WAR ? ~(cpu_icache_line_size()-1) : ALMASK)); | 
| Ralf Baechle | 02416dc | 2005-06-15 13:00:12 +0000 | [diff] [blame] | 149 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 150 |  | 
| Ralf Baechle | 02416dc | 2005-06-15 13:00:12 +0000 | [diff] [blame] | 151 | static inline int install_sigtramp(unsigned int __user *tramp, | 
|  | 152 | unsigned int syscall) | 
|  | 153 | { | 
|  | 154 | int err; | 
|  | 155 |  | 
|  | 156 | /* | 
|  | 157 | * Set up the return code ... | 
|  | 158 | * | 
|  | 159 | *         li      v0, __NR__foo_sigreturn | 
|  | 160 | *         syscall | 
|  | 161 | */ | 
|  | 162 |  | 
|  | 163 | err = __put_user(0x24020000 + syscall, tramp + 0); | 
|  | 164 | err |= __put_user(0x0000000c          , tramp + 1); | 
|  | 165 | if (ICACHE_REFILLS_WORKAROUND_WAR) { | 
|  | 166 | err |= __put_user(0, tramp + 2); | 
|  | 167 | err |= __put_user(0, tramp + 3); | 
|  | 168 | err |= __put_user(0, tramp + 4); | 
|  | 169 | err |= __put_user(0, tramp + 5); | 
|  | 170 | err |= __put_user(0, tramp + 6); | 
|  | 171 | err |= __put_user(0, tramp + 7); | 
|  | 172 | } | 
|  | 173 | flush_cache_sigtramp((unsigned long) tramp); | 
|  | 174 |  | 
|  | 175 | return err; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 176 | } |