[444] | 1 | /* A setjmp.c for CRIS |
---|
| 2 | Copyright (C) 1993-2005 Axis Communications. |
---|
| 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 |
---|
| 7 | are met: |
---|
| 8 | |
---|
| 9 | 1. Redistributions of source code must retain the above copyright |
---|
| 10 | notice, this list of conditions and the following disclaimer. |
---|
| 11 | |
---|
| 12 | 2. Neither the name of Axis Communications nor the names of its |
---|
| 13 | contributors may be used to endorse or promote products derived |
---|
| 14 | from this software without specific prior written permission. |
---|
| 15 | |
---|
| 16 | THIS SOFTWARE IS PROVIDED BY AXIS COMMUNICATIONS AND ITS 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 AXIS |
---|
| 20 | COMMUNICATIONS OR ITS CONTRIBUTORS BE LIABLE FOR ANY DIRECT, |
---|
| 21 | INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES |
---|
| 22 | (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR |
---|
| 23 | SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) |
---|
| 24 | HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, |
---|
| 25 | STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING |
---|
| 26 | IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
---|
| 27 | POSSIBILITY OF SUCH DAMAGE. */ |
---|
| 28 | |
---|
| 29 | /* For benefit of CRIS v0..v3, we save and restore CCR to be able to |
---|
| 30 | correctly handle DI/EI; otherwise there would be no reason to save it. |
---|
| 31 | Note also that the "move x,ccr" does NOT affect |
---|
| 32 | the DMA enable bits (E and D) of v0..v3. |
---|
| 33 | |
---|
| 34 | We do not save mof; it is call-clobbered. It also does not exist in |
---|
| 35 | v0..v8; it should be safe to read or write to it there, but better not. |
---|
| 36 | |
---|
| 37 | jmp_buf[0] - PC |
---|
| 38 | jmp_buf[1] - SP (R14) |
---|
| 39 | jmp_buf[2] - R13 |
---|
| 40 | jmp_buf[3] - R12 |
---|
| 41 | jmp_buf[4] - R11 |
---|
| 42 | jmp_buf[5] - R10 |
---|
| 43 | jmp_buf[6] - R9 |
---|
| 44 | jmp_buf[7] - R8 |
---|
| 45 | jmp_buf[8] - R7 |
---|
| 46 | jmp_buf[9] - R6 |
---|
| 47 | jmp_buf[10] - R5 |
---|
| 48 | jmp_buf[11] - R4 |
---|
| 49 | jmp_buf[12] - R3 |
---|
| 50 | jmp_buf[13] - R2 |
---|
| 51 | jmp_buf[14] - R1 |
---|
| 52 | jmp_buf[15] - R0 |
---|
| 53 | jmp_buf[16] - SRP |
---|
| 54 | jmp_buf[17] - CCR |
---|
| 55 | */ |
---|
| 56 | |
---|
| 57 | #include <setjmp.h> |
---|
| 58 | |
---|
| 59 | int |
---|
| 60 | setjmp (jmp_buf buf) |
---|
| 61 | { |
---|
| 62 | int ret; |
---|
| 63 | #if defined (__arch_common_v10_v32) || defined (__arch_v32) |
---|
| 64 | /* No offsets in the compatibility mode. Also, movem saves in |
---|
| 65 | different order on v10 than on v32, so we use single move |
---|
| 66 | instructions instead, this not being a speed-prioritized operation. |
---|
| 67 | And we don't save CCR or CCS; since long unuseful. */ |
---|
| 68 | __asm__ __volatile__ |
---|
| 69 | ("move.d %1,$r13 \n\ |
---|
| 70 | move 0f,$mof \n\ |
---|
| 71 | move $mof,[$r13+] \n\ |
---|
| 72 | move.d $sp,[$r13+] \n\ |
---|
| 73 | clear.d [$r13+] \n\ |
---|
| 74 | move.d $r12,[$r13+] \n\ |
---|
| 75 | move.d $r11,[$r13+] \n\ |
---|
| 76 | move.d $r10,[$r13+] \n\ |
---|
| 77 | moveq 1,$r9 \n\ |
---|
| 78 | move.d $r9,[$r13+] \n\ |
---|
| 79 | move.d $r8,[$r13+] \n\ |
---|
| 80 | move.d $r7,[$r13+] \n\ |
---|
| 81 | move.d $r6,[$r13+] \n\ |
---|
| 82 | move.d $r5,[$r13+] \n\ |
---|
| 83 | move.d $r4,[$r13+] \n\ |
---|
| 84 | move.d $r3,[$r13+] \n\ |
---|
| 85 | move.d $r2,[$r13+] \n\ |
---|
| 86 | move.d $r1,[$r13+] \n\ |
---|
| 87 | move.d $r0,[$r13+] \n\ |
---|
| 88 | move $srp,[$r13+] \n\ |
---|
| 89 | clear.d [$r13+] \n\ |
---|
| 90 | clear.d $r9 \n\ |
---|
| 91 | 0: \n\ |
---|
| 92 | move.d $r9,%0" |
---|
| 93 | |
---|
| 94 | /* Output. */ |
---|
| 95 | : "=&r" (ret) |
---|
| 96 | |
---|
| 97 | /* Input. */ |
---|
| 98 | : "r" (buf) |
---|
| 99 | |
---|
| 100 | /* Clobber. */ |
---|
| 101 | : "r9", "r13", "memory"); |
---|
| 102 | #else /* not __arch_common_v10_v32 or __arch_v32 */ |
---|
| 103 | #ifdef __PIC__ |
---|
| 104 | __asm__ __volatile__ |
---|
| 105 | ("moveq 1,$r9 \n\ |
---|
| 106 | movem $sp,[%1+1*4] \n\ |
---|
| 107 | move.d $pc,$r9 \n\ |
---|
| 108 | addq 0f-.,$r9 \n\ |
---|
| 109 | move.d $r9,[%1] \n\ |
---|
| 110 | move $srp,[%1+16*4] \n\ |
---|
| 111 | move $ccr,[%1+17*4] \n\ |
---|
| 112 | clear.d $r9 \n\ |
---|
| 113 | 0: \n\ |
---|
| 114 | move.d $r9,%0" |
---|
| 115 | |
---|
| 116 | /* Output. */ |
---|
| 117 | : "=&r" (ret) |
---|
| 118 | |
---|
| 119 | /* Input. */ |
---|
| 120 | : "r" (buf) |
---|
| 121 | |
---|
| 122 | /* Clobber. */ |
---|
| 123 | : "r9", "memory"); |
---|
| 124 | #else /* not PIC */ |
---|
| 125 | __asm__ __volatile__ |
---|
| 126 | ("moveq 1,$r9 \n\ |
---|
| 127 | movem $sp,[%1+1*4] \n\ |
---|
| 128 | move.d 0f,$r9 \n\ |
---|
| 129 | move.d $r9,[%1] \n\ |
---|
| 130 | move $srp,[%1+16*4] \n\ |
---|
| 131 | move $ccr,[%1+17*4] \n\ |
---|
| 132 | clear.d $r9 \n\ |
---|
| 133 | 0: \n\ |
---|
| 134 | move.d $r9,%0" |
---|
| 135 | |
---|
| 136 | /* Output. */ |
---|
| 137 | : "=&r" (ret) |
---|
| 138 | |
---|
| 139 | /* Input. */ |
---|
| 140 | : "r" (buf) |
---|
| 141 | |
---|
| 142 | /* Clobber. */ |
---|
| 143 | : "r9"); |
---|
| 144 | #endif /* not PIC */ |
---|
| 145 | #endif /* not __arch_common_v10_v32 or __arch_v32 */ |
---|
| 146 | return ret; |
---|
| 147 | } |
---|
| 148 | |
---|
| 149 | void |
---|
| 150 | longjmp(jmp_buf buf, int val) |
---|
| 151 | { |
---|
| 152 | #if defined (__arch_common_v10_v32) || defined (__arch_v32) |
---|
| 153 | __asm__ __volatile__ |
---|
| 154 | ("cmpq 0,%1 \n\ |
---|
| 155 | beq 0f \n\ |
---|
| 156 | move.d %0,$r13 ; In delay-slot. \n\ |
---|
| 157 | addq 6*4,$r13 \n\ |
---|
| 158 | move.d %1,[$r13] \n\ |
---|
| 159 | subq 6*4,$r13 \n\ |
---|
| 160 | 0:\n" |
---|
| 161 | #ifdef __arch_common_v10_v32 |
---|
| 162 | /* Cater to branch offset difference between v32 and v10. We |
---|
| 163 | assume the branch above is 8-bit. */ |
---|
| 164 | " setf\n" |
---|
| 165 | #endif |
---|
| 166 | " move [$r13+],$mof \n\ |
---|
| 167 | move.d [$r13+],$sp \n\ |
---|
| 168 | addq 4,$r13 \n\ |
---|
| 169 | move.d [$r13+],$r12 \n\ |
---|
| 170 | move.d [$r13+],$r11 \n\ |
---|
| 171 | move.d [$r13+],$r10 \n\ |
---|
| 172 | move.d [$r13+],$r9 \n\ |
---|
| 173 | move.d [$r13+],$r8 \n\ |
---|
| 174 | move.d [$r13+],$r7 \n\ |
---|
| 175 | move.d [$r13+],$r6 \n\ |
---|
| 176 | move.d [$r13+],$r5 \n\ |
---|
| 177 | move.d [$r13+],$r4 \n\ |
---|
| 178 | move.d [$r13+],$r3 \n\ |
---|
| 179 | move.d [$r13+],$r2 \n\ |
---|
| 180 | move.d [$r13+],$r1 \n\ |
---|
| 181 | move.d [$r13+],$r0 \n\ |
---|
| 182 | move [$r13+],$srp \n\ |
---|
| 183 | move $mof,$r13 \n\ |
---|
| 184 | jump $r13 \n\ |
---|
| 185 | setf" |
---|
| 186 | |
---|
| 187 | /* No outputs. */ |
---|
| 188 | : |
---|
| 189 | |
---|
| 190 | /* Inputs. */ |
---|
| 191 | : "r" (buf), "r" (val) |
---|
| 192 | : "r13", "memory"); |
---|
| 193 | |
---|
| 194 | #else /* not __arch_common_v10_v32 or __arch_v32 */ |
---|
| 195 | __asm__ __volatile__ |
---|
| 196 | ("move [%0+17*4],$ccr \n\ |
---|
| 197 | move [%0+16*4],$srp \n\ |
---|
| 198 | test.d %1 \n\ |
---|
| 199 | beq 0f \n\ |
---|
| 200 | nop \n\ |
---|
| 201 | move.d %1,[%0+6*4] ; Offset for r9. \n\ |
---|
| 202 | 0: \n\ |
---|
| 203 | movem [%0],$pc" |
---|
| 204 | |
---|
| 205 | /* No outputs. */ |
---|
| 206 | : |
---|
| 207 | |
---|
| 208 | /* Inputs. */ |
---|
| 209 | : "r" (buf), "r" (val) |
---|
| 210 | : "memory"); |
---|
| 211 | #endif /* not __arch_common_v10_v32 or __arch_v32 */ |
---|
| 212 | } |
---|