sdcc/device/lib/_setjmp.c

   1 /*-------------------------------------------------------------------------
   2    setjmp.c - source file for ANSI routines setjmp & longjmp
   3
   4    Copyright (C) 1999, Sandeep Dutta . sandeep.dutta@usa.net
   5
   6    This library is free software; you can redistribute it and/or modify it
   7    under the terms of the GNU General Public License as published by the
   8    Free Software Foundation; either version 2, or (at your option) any
   9    later version.
  10
  11    This library is distributed in the hope that it will be useful,
  12    but WITHOUT ANY WARRANTY; without even the implied warranty of
  13    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14    GNU General Public License for more details.
  15
  16    You should have received a copy of the GNU General Public License
  17    along with this library; see the file COPYING. If not, write to the
  18    Free Software Foundation, 51 Franklin Street, Fifth Floor, Boston,
  19    MA 02110-1301, USA.
  20
  21    As a special exception, if you link this library with other files,
  22    some of which are compiled with SDCC, to produce an executable,
  23    this library does not by itself cause the resulting executable to
  24    be covered by the GNU General Public License. This exception does
  25    not however invalidate any other reasons why the executable file
  26    might be covered by the GNU General Public License.
  27 -------------------------------------------------------------------------*/
  28
  29 #include <sdcc-lib.h>
  30 #define __SDCC_HIDE_LONGJMP
  31 #include <setjmp.h>
  32
  33 #if defined(__SDCC_ds390)
  34
  35 #include <ds80c390.h>
  36
  37 int __setjmp (jmp_buf buf)
  38 {
  39     unsigned char sp, esp;
  40     unsigned long lsp;
  41
  42     /* registers would have been saved on the
  43        stack anyway so we need to save SP
  44        and the return address */
  45     __critical {
  46         sp = SP;
  47         esp = ESP;
  48     }
  49     lsp = sp;
  50     lsp |= (unsigned int)(esp << 8);
  51     lsp |= 0x400000;
  52     *buf++ = lsp;
  53     *buf++ = lsp >> 8;
  54     *buf++ = *((unsigned char __xdata *) lsp - 0);
  55     *buf++ = *((unsigned char __xdata *) lsp - 1);
  56     *buf++ = *((unsigned char __xdata *) lsp - 2);
  57     return 0;
  58 }
  59
  60 int longjmp (jmp_buf buf, int rv)
  61 {
  62     unsigned long lsp;
  63
  64     lsp = *buf++;
  65     lsp |= (unsigned int)(*buf++ << 8);
  66     lsp |= 0x400000;
  67     *((unsigned char __xdata *) lsp - 0) = *buf++;
  68     *((unsigned char __xdata *) lsp - 1) = *buf++;
  69     *((unsigned char __xdata *) lsp - 2) = *buf++;
  70     __critical {
  71         SP = lsp;
  72         ESP = lsp >> 8;
  73     }
  74     return rv ? rv : 1;
  75 }
  76
  77 #elif defined(__SDCC_STACK_AUTO) && defined(__SDCC_USE_XSTACK)
  78
  79 static void dummy (void) __naked
  80 {
  81         __asm
  82
  83 ;------------------------------------------------------------
  84 ;Allocation info for local variables in function 'setjmp'
  85 ;------------------------------------------------------------
  86 ;buf                       Allocated to registers dptr b
  87 ;------------------------------------------------------------
  88 ;../../device/lib/_setjmp.c:180:int setjmp (jmp_buf buf)
  89 ;       -----------------------------------------
  90 ;        function setjmp
  91 ;       -----------------------------------------
  92         .globl ___setjmp
  93 ___setjmp:
  94         ar2 = 0x02
  95         ar3 = 0x03
  96         ar4 = 0x04
  97         ar5 = 0x05
  98         ar6 = 0x06
  99         ar7 = 0x07
 100         ar0 = 0x00
 101         ar1 = 0x01
 102 ;../../device/lib/_setjmp.c:183:*buf++ = bpx;
 103 ;     genPointerSet
 104 ;     genGenPointerSet
 105         mov     a,_bpx
 106         lcall   __gptrput
 107         inc     dptr
 108 ;../../device/lib/_setjmp.c:184:*buf++ = spx;
 109 ;     genPointerSet
 110 ;     genGenPointerSet
 111         mov     a,_spx
 112         lcall   __gptrput
 113         inc     dptr
 114 ;../../device/lib/_setjmp.c:185:*buf++ = bp;
 115 ;     genPointerSet
 116 ;     genGenPointerSet
 117         mov     a,_bp
 118         lcall   __gptrput
 119         inc     dptr
 120 ;../../device/lib/_setjmp.c:186:*buf++ = SP;
 121 ;     genPointerSet
 122 ;     genGenPointerSet
 123         mov     a,sp
 124         lcall   __gptrput
 125         inc     dptr
 126 ;../../device/lib/_setjmp.c:187:*buf++ = *((unsigned char __data *) SP  );
 127 ;     genCast
 128 ;     genPointerGet
 129 ;     genNearPointerGet
 130 ;     genPointerSet
 131 ;     genGenPointerSet
 132         mov     r0,sp
 133         mov     a,@r0
 134         lcall   __gptrput
 135         inc     dptr
 136 ;../../device/lib/_setjmp.c:188:*buf   = *((unsigned char __data *)SP - 1);
 137 ;     genCast
 138 ;     genMinus
 139 ;     genMinusDec
 140 ;       peephole 177.g  optimized mov sequence
 141         dec     r0
 142 ;     genPointerGet
 143 ;     genNearPointerGet
 144         mov     a,@r0
 145 ;     genPointerSet
 146 ;     genGenPointerSet
 147         lcall   __gptrput
 148 #ifdef __SDCC_MODEL_HUGE
 149         inc     dptr
 150 ;../../device/lib/_setjmp.c:189:*buf   = *((unsigned char __data *)SP - 2);
 151 ;     genCast
 152 ;     genMinus
 153 ;     genMinusDec
 154 ;       peephole 177.g  optimized mov sequence
 155         dec     r0
 156 ;     genPointerGet
 157 ;     genNearPointerGet
 158         mov     a,@r0
 159 ;     genPointerSet
 160 ;     genGenPointerSet
 161         lcall   __gptrput
 162 #endif
 163 ;../../device/lib/_setjmp.c:190:return 0;
 164 ;     genRet
 165         mov     dptr,#0x0000
 166         _RETURN
 167
 168 ;------------------------------------------------------------
 169 ;Allocation info for local variables in function 'longjmp'
 170 ;------------------------------------------------------------
 171 ;rv                        Allocated to stack - offset -2
 172 ;buf                       Allocated to registers dptr b
 173 ;lsp                       Allocated to registers r5
 174 ;------------------------------------------------------------
 175 ;../../device/lib/_setjmp.c:192:int longjmp (jmp_buf buf, int rv)
 176 ;       -----------------------------------------
 177 ;        function longjmp
 178 ;       -----------------------------------------
 179         .globl _longjmp
 180 _longjmp:
 181 ;     genReceive
 182         mov     r0,_spx
 183         dec     r0
 184         movx    a,@r0
 185         mov     r2,a
 186         dec     r0
 187         movx    a,@r0
 188         mov     r3,a
 189 ;../../device/lib/_setjmp.c:193:bpx = *buf++;
 190 ;     genPointerGet
 191 ;     genGenPointerGet
 192         lcall   __gptrget
 193         mov     _bpx,a
 194         inc     dptr
 195 ;../../device/lib/_setjmp.c:194:spx = *buf++;
 196 ;     genPointerGet
 197 ;     genGenPointerGet
 198         lcall   __gptrget
 199         mov     _spx,a
 200         inc     dptr
 201 ;../../device/lib/_setjmp.c:195:bp = *buf++;
 202 ;     genPointerGet
 203 ;     genGenPointerGet
 204         lcall   __gptrget
 205         mov     _bp,a
 206         inc     dptr
 207 ;../../device/lib/_setjmp.c:196:lsp = *buf++;
 208 ;     genPointerGet
 209 ;     genGenPointerGet
 210         lcall   __gptrget
 211         inc     dptr
 212 ;     genAssign
 213         mov     r5,a
 214 ;../../device/lib/_setjmp.c:197:*((unsigned char __data *) lsp) = *buf++;
 215 ;     genCast
 216         mov     r0,a
 217 ;     genPointerGet
 218 ;     genGenPointerGet
 219         lcall   __gptrget
 220         inc     dptr
 221 ;     genPointerSet
 222 ;     genNearPointerSet
 223         mov     @r0,a
 224 ;../../device/lib/_setjmp.c:198:*((unsigned char __data *) lsp - 1) = *buf;
 225 ;     genMinus
 226 ;     genMinusDec
 227         dec     r0
 228 ;     genPointerGet
 229 ;     genGenPointerGet
 230         lcall   __gptrget
 231 ;     genPointerSet
 232 ;     genNearPointerSet
 233         mov     @r0,a
 234 #ifdef __SDCC_MODEL_HUGE
 235         inc     dptr
 236 ;../../device/lib/_setjmp.c:199:*((unsigned char __data *) lsp - 2) = *buf;
 237 ;     genMinus
 238 ;     genMinusDec
 239         dec     r0
 240 ;     genPointerGet
 241 ;     genGenPointerGet
 242         lcall   __gptrget
 243 ;     genPointerSet
 244 ;     genNearPointerSet
 245         mov     @r0,a
 246 #endif
 247 ;../../device/lib/_setjmp.c:200:SP = lsp;
 248 ;     genAssign
 249         mov     sp,r5
 250 ;../../device/lib/_setjmp.c:201:return rv ? rv : 1;
 251 ;     genAssign
 252         mov     dph,r2
 253         mov     dpl,r3
 254         mov     a,r2
 255         orl     a,r3
 256         jnz     00001$
 257         inc     dptr
 258 ;     genRet
 259 00001$:
 260         _RETURN
 261
 262         __endasm;
 263 }
 264
 265 #elif defined(__SDCC_STACK_AUTO)
 266
 267 static void dummy (void) __naked
 268 {
 269         __asm
 270
 271 ;------------------------------------------------------------
 272 ;Allocation info for local variables in function 'setjmp'
 273 ;------------------------------------------------------------
 274 ;buf                       Allocated to registers dptr b
 275 ;------------------------------------------------------------
 276 ;../../device/lib/_setjmp.c:122:int setjmp (unsigned char *buf)
 277 ;       -----------------------------------------
 278 ;        function setjmp
 279 ;       -----------------------------------------
 280         .globl ___setjmp
 281 ___setjmp:
 282         ar2 = 0x02
 283         ar3 = 0x03
 284         ar4 = 0x04
 285         ar5 = 0x05
 286         ar6 = 0x06
 287         ar7 = 0x07
 288         ar0 = 0x00
 289         ar1 = 0x01
 290 ;     genReceive
 291 ;../../device/lib/_setjmp.c:125:*buf   = BP;
 292 ;     genPointerSet
 293 ;     genGenPointerSet
 294         mov     a,_bp
 295         lcall   __gptrput
 296         inc     dptr
 297 ;../../device/lib/_setjmp.c:126:*buf   = SP;
 298 ;     genPointerSet
 299 ;     genGenPointerSet
 300         mov     a,sp
 301         lcall   __gptrput
 302         inc     dptr
 303 ;../../device/lib/_setjmp.c:127:*buf++ = *((unsigned char __data *) SP  );
 304 ;     genCast
 305         mov     r0,sp
 306 ;     genPointerGet
 307 ;     genNearPointerGet
 308         mov     a,@r0
 309 ;     genPointerSet
 310 ;     genGenPointerSet
 311         lcall   __gptrput
 312         inc     dptr
 313 ;../../device/lib/_setjmp.c:128:*buf++ = *((unsigned char __data *)SP - 1);
 314 ;     genCast
 315 ;     genMinus
 316 ;     genMinusDec
 317         dec     r0
 318 ;     genPointerGet
 319 ;     genNearPointerGet
 320         mov     a,@r0
 321 ;     genPointerSet
 322 ;     genGenPointerSet
 323         lcall   __gptrput
 324 #ifdef __SDCC_MODEL_HUGE
 325         inc     dptr
 326 ;../../device/lib/_setjmp.c:129:*buf++ = *((unsigned char __data *)SP - 2);
 327 ;     genCast
 328 ;     genMinus
 329 ;     genMinusDec
 330         dec     r0
 331 ;     genPointerGet
 332 ;     genNearPointerGet
 333         mov     a,@r0
 334 ;     genPointerSet
 335 ;     genGenPointerSet
 336         lcall   __gptrput
 337 #endif
 338 ;../../device/lib/_setjmp.c:130:return 0;
 339 ;     genRet
 340         mov     dptr,#0x0000
 341         _RETURN
 342
 343 ;------------------------------------------------------------
 344 ;Allocation info for local variables in function 'longjmp'
 345 ;------------------------------------------------------------
 346 ;rv                        Allocated to stack - offset -3
 347 ;buf                       Allocated to registers dptr b
 348 ;lsp                       Allocated to registers r5
 349 ;------------------------------------------------------------
 350 ;../../device/lib/_setjmp.c:28:int longjmp (jmp_buf buf, int rv)
 351 ;       -----------------------------------------
 352 ;        function longjmp
 353 ;       -----------------------------------------
 354         .globl _longjmp
 355 _longjmp:
 356         ar2 = 0x02
 357         ar3 = 0x03
 358         ar4 = 0x04
 359         ar5 = 0x05
 360         ar6 = 0x06
 361         ar7 = 0x07
 362         ar0 = 0x00
 363         ar1 = 0x01
 364 ;     genReceive
 365         mov     r0,sp
 366         dec     r0
 367         dec     r0
 368 #ifdef __SDCC_MODEL_HUGE
 369         dec     r0
 370 #endif
 371         mov     ar2,@r0
 372         dec     r0
 373         mov     ar3,@r0
 374 ;../../device/lib/_setjmp.c:30:bp = *buf++;
 375 ;     genPointerGet
 376 ;     genGenPointerGet
 377         lcall   __gptrget
 378         inc     dptr
 379 ;     genAssign
 380         mov     _bp,a
 381 ;../../device/lib/_setjmp.c:31:lsp = *buf++;
 382 ;     genPointerGet
 383 ;     genGenPointerGet
 384         lcall   __gptrget
 385         inc     dptr
 386 ;     genAssign
 387         mov     r5,a
 388 ;../../device/lib/_setjmp.c:32:*((unsigned char __data *) lsp) = *buf++;
 389 ;     genCast
 390         mov     r0,a
 391 ;     genPointerGet
 392 ;     genGenPointerGet
 393         lcall   __gptrget
 394         inc     dptr
 395 ;     genPointerSet
 396 ;     genNearPointerSet
 397         mov     @r0,a
 398 ;../../device/lib/_setjmp.c:33:*((unsigned char __data *) lsp - 1) = *buf;
 399 ;     genCast
 400 ;     genMinus
 401 ;     genMinusDec
 402         dec     r0
 403 ;     genPointerGet
 404 ;     genGenPointerGet
 405         lcall   __gptrget
 406 ;     genPointerSet
 407 ;     genNearPointerSet
 408         mov     @r0,a
 409 #ifdef __SDCC_MODEL_HUGE
 410         inc     dptr
 411 ;../../device/lib/_setjmp.c:34:*((unsigned char __data *) lsp - 2) = *buf;
 412 ;     genCast
 413 ;     genMinus
 414 ;     genMinusDec
 415         dec     r0
 416 ;     genPointerGet
 417 ;     genGenPointerGet
 418         lcall   __gptrget
 419 ;     genPointerSet
 420 ;     genNearPointerSet
 421         mov     @r0,a
 422 #endif
 423 ;../../device/lib/_setjmp.c:35:SP = lsp;
 424 ;     genAssign
 425         mov     sp,r5
 426 ;../../device/lib/_setjmp.c:36:return rv ? rv : 1;
 427 ;     genAssign
 428         mov     dph,r2
 429         mov     dpl,r3
 430         mov     a,r2
 431         orl     a,r3
 432         jnz     00001$
 433         inc     dptr
 434 ;     genRet
 435 00001$:
 436         _RETURN
 437
 438         __endasm;
 439 }
 440
 441 #else
 442
 443 #include <8051.h>
 444
 445 extern unsigned char __data spx;
 446 extern unsigned char __data bpx;
 447
 448 int __setjmp (jmp_buf buf)
 449 {
 450     /* registers would have been saved on the
 451        stack anyway so we need to save SP
 452        and the return address */
 453 #ifdef __SDCC_USE_XSTACK
 454     *buf++ = spx;
 455     *buf++ = bpx;
 456 #endif
 457     *buf++ = SP;
 458     *buf++ = *((unsigned char __idata *) SP - 0);
 459     *buf++ = *((unsigned char __idata *) SP - 1);
 460 #ifdef __SDCC_MODEL_HUGE
 461     *buf++ = *((unsigned char __idata *) SP - 2);
 462 #endif
 463     return 0;
 464 }
 465
 466 int longjmp (jmp_buf buf, int rv)
 467 {
 468     unsigned char lsp;
 469
 470 #ifdef __SDCC_USE_XSTACK
 471     spx = *buf++;
 472     bpx = *buf++;
 473 #endif
 474     lsp = *buf++;
 475     *((unsigned char __idata *) lsp - 0) = *buf++;
 476     *((unsigned char __idata *) lsp - 1) = *buf++;
 477 #ifdef __SDCC_MODEL_HUGE
 478     *((unsigned char __idata *) lsp - 2) = *buf++;
 479 #endif
 480     SP = lsp;
 481     return rv ? rv : 1;
 482 }
 483
 484 #endif