sdcc/device/lib/stm8-large/setjmp.s

   1 ;--------------------------------------------------------------------------
   2 ;  setjmp.s
   3 ;
   4 ;  Copyright (C) 2014-2021, Philipp Klaus Krause
   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         .area   CODE
  30
  31         .globl ___setjmp
  32
  33 ___setjmp:
  34         ; store return address
  35         ldw     y, (1, sp)
  36         ldw     (x), y
  37         ld      a, (3, sp)
  38         ld      (2, x), a
  39
  40         ; store stack pointer
  41         ldw     y, sp
  42         ldw     (3, x), y
  43
  44         ; return 0
  45         clrw    x
  46
  47         retf
  48
  49         .globl _longjmp
  50
  51 _longjmp:
  52         ldw     y, (4, sp)
  53
  54         ; Restore stack pointer
  55         pushw   x
  56         ldw     x, (3, x)
  57         ldw     (1, x), y
  58         popw    y
  59         ldw     sp, x
  60
  61         ; Calculate return value
  62         popw    x
  63         pop     a
  64         tnzw    x
  65         jrne    jump
  66         incw    x
  67 jump:
  68         ; return
  69         ld      a, (y)
  70         ldw     y, (1, y)
  71         pushw   y
  72         push    a
  73         retf
  74