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

   1 /*-------------------------------------------------------------------------
   2
   3    gptrget4.c :- get 4 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: gptrget4.c 3714 2005-04-02 13:13:53Z vrokas $
  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: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 _gptrget4(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     movff       _POSTINC0, _FSR0L
  68
  69     return
  70
  71
  72 _lab_01_:
  73     /* code or eeprom */
  74     btfsc       _WREG, 6
  75     bra         _lab_02_
  76
  77     ; code pointer
  78     movff       _FSR0L, _TBLPTRL
  79     movff       _PRODL, _TBLPTRH
  80     movwf       _TBLPTRU
  81
  82     /* fetch first byte */
  83     TBLRD*+
  84     movf        _TABLAT, w
  85
  86     /* fetch second byte  */
  87     TBLRD*+
  88     movff       _TABLAT, _PRODL
  89
  90     /* fetch third byte */
  91     TBLRD*+
  92     movff       _TABLAT, _PRODH
  93
  94     /* fetch fourth byte */
  95     TBLRD*+
  96     movff       _TABLAT, _FSR0L
  97
  98     return
  99
 100 _lab_02_:
 101     /* EEPROM pointer */
 102
 103     /* unimplemented yet */
 104
 105   return
 106
 107   __endasm;
 108 }