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

   1 /*-------------------------------------------------------------------------
   2
   3    gptrput1.c :- put 2 byte value at 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 /* write address is expected to be in WREG:PRODL:FSR0L while
  33  * write value is in TBLPTRL:TBLPTRH:PRODH:[stack] */
  34
  35 extern POSTINC0;
  36 extern PREINC1;
  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 extern _GPTRREG;
  48
  49 void _gptrput2(void) _naked
  50 {
  51   _asm
  52     /* decode generic pointer MSB (in WREG) bits 6 and 7:
  53      * 00 -> code (unimplemented)
  54      * 01 -> EEPROM (unimplemented)
  55      * 10 -> data
  56      * 11 -> unimplemented
  57      */
  58     btfss       _WREG, 7
  59     bra         _lab_01_
  60
  61     /* data pointer  */
  62     /* data are already in FSR0 */
  63     movff       _PRODL, _FSR0H
  64
  65     movff       _PREINC1, _POSTINC0
  66     movff       _PRODH, _POSTINC0
  67
  68     return
  69
  70
  71 _lab_01_:
  72     /* code or eeprom */
  73     btfss       _WREG, 6
  74     return
  75
  76     /* code pointer, cannot write code pointers */
  77
  78
  79 _lab_02_:
  80     /* EEPROM pointer */
  81
  82     /* unimplemented yet */
  83
  84
  85   return
  86   _endasm;
  87 }