git.gag.com Git - fw/sdcc/blob - device/lib/pic16/libsdcc/gptr/gptrget2.c

   1 /*-------------------------------------------------------------------------
   2
   3    gptrget2.c :- get 2 byte value from generic pointer
   4
   5    Adopted for pic16 port by Vangelis Rokas, 2004 (vrokas@otenet.gr)
   6
   7              Written By -  Sandeep Dutta . sandeep.dutta@usa.net (1999)
   8
   9    This library is free software; you can redistribute it and/or modify it
  10    under the terms of the GNU Library General Public License as published by the
  11    Free Software Foundation; either version 2, or (at your option) any
  12    later version.
  13
  14    This library is distributed in the hope that it will be useful,
  15    but WITHOUT ANY WARRANTY; without even the implied warranty of
  16    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17    GNU Library General Public License for more details.
  18
  19    You should have received a copy of the GNU Library General Public License
  20    along with this program; if not, write to the Free Software
  21    Foundation, 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  22
  23    In other words, you are welcome to use, share and improve this program.
  24    You are forbidden to forbid anyone else to use, share and improve
  25    what you give them.   Help stamp out software-hoarding!
  26 -------------------------------------------------------------------------*/
  27
  28 /*
  29 ** $Id$
  30 */
  31
  32 /* the return value is expected to be in WREG:PRODL, therefore we choose return
  33  * type void here. Generic pointer is expected to be in WREG:FSR0H:FSR0L,
  34  * so function arguments are void, too */
  35
  36 extern POSTINC0;
  37 extern INDF0;
  38 extern FSR0L;
  39 extern FSR0H;
  40 extern WREG;
  41 extern TBLPTRL;
  42 extern TBLPTRH;
  43 extern TBLPTRU;
  44 extern TABLAT;
  45 extern PRODL;
  46
  47 void _gptrget2(void) _naked
  48 {
  49   _asm
  50     /* decode generic pointer MSB (in WREG) bits 6 and 7:
  51      * 00 -> code
  52      * 01 -> EEPROM
  53      * 10 -> data
  54      * 11 -> unimplemented
  55      */
  56     btfss       _WREG, 7
  57     goto        _lab_01_
  58
  59     /* data pointer  */
  60     /* data are already in FSR0 */
  61     movf        _POSTINC0, w
  62     movff       _POSTINC0, _PRODL
  63
  64     goto _end_
  65
  66
  67 _lab_01_:
  68     /* code or eeprom */
  69     btfsc       _WREG, 6
  70     goto        _lab_02_
  71
  72     ; code pointer
  73     movwf       _TBLPTRU
  74     movff       _FSR0L, _TBLPTRL
  75     movff       _FSR0H, _TBLPTRH
  76
  77     /* fetch first byte */
  78     TBLRD*+
  79     movf        _TABLAT, w
  80
  81     /* fetch second byte  */
  82     TBLRD*+
  83     movff       _TABLAT, _PRODL
  84
  85     goto _end_
  86
  87
  88 _lab_02_:
  89     /* EEPROM pointer */
  90
  91     /* unimplemented yet */
  92
  93 _end_:
  94
  95   _endasm;
  96 }