git.gag.com Git - debian/cc1111/blob - device/lib/pic16/libsdcc/gptr/gptrget3.c

   1 /*-------------------------------------------------------------------------
   2
   3    gptrget3.c :- get 3 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: gptrget3.c 3714 2005-04-02 13:13:53Z vrokas $
  30 */
  31
  32 /* the return value is expected to be in WREG:PRODL:PRODH, therefore we choose return
  33  * type void here. Generic pointer is expected to be in WREG:PRODL: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 extern PRODH;
  47
  48 void _gptrget3(void) __naked
  49 {
  50   __asm
  51     /* decode generic pointer MSB (in WREG) bits 6 and 7:
  52      * 00 -> code
  53      * 01 -> EEPROM
  54      * 10 -> data
  55      * 11 -> unimplemented
  56      */
  57     btfss       _WREG, 7
  58     bra         _lab_01_
  59
  60     /* data pointer  */
  61     /* data are already in FSR0 */
  62     movff       _PRODL, _FSR0H
  63
  64     movf        _POSTINC0, w
  65     movff       _POSTINC0, _PRODL
  66     movff       _POSTINC0, _PRODH
  67
  68     return
  69
  70
  71 _lab_01_:
  72     /* code or eeprom */
  73     btfsc       _WREG, 6
  74     bra         _lab_02_
  75
  76     ; code pointer
  77     movff       _FSR0L, _TBLPTRL
  78     movff       _PRODL, _TBLPTRH
  79     movwf       _TBLPTRU
  80
  81     /* fetch first byte */
  82     TBLRD*+
  83     movf        _TABLAT, w
  84
  85     /* fetch second byte  */
  86     TBLRD*+
  87     movff       _TABLAT, _PRODL
  88
  89     /* fetch third byte */
  90     TBLRD*+
  91     movff       _TABLAT, _PRODH
  92
  93     return
  94
  95
  96 _lab_02_:
  97     /* EEPROM pointer */
  98
  99     /* unimplemented yet */
 100
 101   return
 102   __endasm;
 103 }