arch/arm/nwfpe/fpmodule.inl

   1 /*
   2     NetWinder Floating Point Emulator
   3     (c) Rebel.COM, 1998,1999
   4
   5     Direct questions, comments to Scott Bambrough <scottb@netwinder.org>
   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 static inline unsigned long readRegister(const unsigned int nReg)
  23 {
  24         /* Note: The CPU thinks it has dealt with the current instruction.
  25            As a result the program counter has been advanced to the next
  26            instruction, and points 4 bytes beyond the actual instruction
  27            that caused the invalid instruction trap to occur.  We adjust
  28            for this in this routine.  LDF/STF instructions with Rn = PC
  29            depend on the PC being correct, as they use PC+8 in their
  30            address calculations. */
  31         struct pt_regs *regs = GET_USERREG();
  32         unsigned int val = regs->uregs[nReg];
  33         if (REG_PC == nReg)
  34                 val -= 4;
  35         return val;
  36 }
  37
  38 static inline void
  39 writeRegister(const unsigned int nReg, const unsigned long val)
  40 {
  41         struct pt_regs *regs = GET_USERREG();
  42         regs->uregs[nReg] = val;
  43 }
  44
  45 static inline unsigned long readCPSR(void)
  46 {
  47         return (readRegister(REG_CPSR));
  48 }
  49
  50 static inline void writeCPSR(const unsigned long val)
  51 {
  52         writeRegister(REG_CPSR, val);
  53 }
  54
  55 static inline unsigned long readConditionCodes(void)
  56 {
  57 #ifdef __FPEM_TEST__
  58         return (0);
  59 #else
  60         return (readCPSR() & CC_MASK);
  61 #endif
  62 }
  63
  64 static inline void writeConditionCodes(const unsigned long val)
  65 {
  66         struct pt_regs *regs = GET_USERREG();
  67         unsigned long rval;
  68         /*
  69          * Operate directly on userRegisters since
  70          * the CPSR may be the PC register itself.
  71          */
  72         rval = regs->ARM_cpsr & ~CC_MASK;
  73         regs->ARM_cpsr = rval | (val & CC_MASK);
  74 }