i386/linux/linux-2.3.21/arch/arm/nwfpe/fpmodule.inl

   1 /*
   2    NetWinder Floating Point Emulator
   3    (c) Corel Computer Corporation, 1998
   4
   5    Direct questions, comments to Scott Bambrough <scottb@corelcomputer.com>
   6
   7    This program is free software; you can redistribute it and/or modify
   8    it under the terms of the GNU General Public License as published by
   9    the Free Software Foundation; either version 2 of the License, or
  10    (at your option) any later version.
  11
  12    This program is distributed in the hope that it will be useful,
  13    but WITHOUT ANY WARRANTY; without even the implied warranty of
  14    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15    GNU General Public License for more details.
  16
  17    You should have received a copy of the GNU General Public License
  18    along with this program; if not, write to the Free Software
  19    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  20  */
  21
  22 /* Address of user registers on the kernel stack. */
  23 extern unsigned int *userRegisters;
  24
  25 extern __inline__
  26 unsigned int readRegister(const unsigned int nReg)
  27 {
  28         /* Note: The CPU thinks it has dealt with the current instruction.  As
  29            a result the program counter has been advanced to the next
  30            instruction, and points 4 bytes beyond the actual instruction
  31            that caused the invalid instruction trap to occur.  We adjust
  32            for this in this routine.  LDF/STF instructions with Rn = PC
  33            depend on the PC being correct, as they use PC+8 in their
  34            address calculations. */
  35         unsigned int val = userRegisters[nReg];
  36
  37         if (REG_PC == nReg)
  38                 val -= 4;
  39
  40         return val;
  41 }
  42
  43 extern __inline__
  44 void writeRegister(const unsigned int nReg, const unsigned int val)
  45 {
  46         userRegisters[nReg] = val;
  47 }
  48
  49 extern __inline__
  50 unsigned int readCPSR(void)
  51 {
  52         return (readRegister(REG_CPSR));
  53 }
  54
  55 extern __inline__
  56 void writeCPSR(const unsigned int val)
  57 {
  58         writeRegister(REG_CPSR, val);
  59 }
  60
  61 extern __inline__
  62 unsigned int readConditionCodes(void)
  63 {
  64 #ifdef __FPEM_TEST__
  65         return (0);
  66 #else
  67         return (readCPSR() & CC_MASK);
  68 #endif
  69 }
  70
  71 extern __inline__
  72 void writeConditionCodes(const unsigned int val)
  73 {
  74         unsigned int rval;
  75
  76         /*
  77          * Operate directly on userRegisters since
  78          * the CPSR may be the PC register itself.
  79          */
  80         rval = userRegisters[REG_CPSR] & ~CC_MASK;
  81         userRegisters[REG_CPSR] = rval | (val & CC_MASK);
  82 }
  83
  84 extern __inline__
  85 unsigned int readMemoryInt(unsigned int *pMem)
  86 {
  87         return *pMem;
  88 }