Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | extern __inline__ |
| 23 | unsigned int readRegister(const unsigned int nReg) |
| 24 | { |
| 25 | /* Note: The CPU thinks it has dealt with the current instruction. As |
| 26 | a result the program counter has been advanced to the next |
| 27 | instruction, and points 4 bytes beyond the actual instruction |
| 28 | that caused the invalid instruction trap to occur. We adjust |
| 29 | for this in this routine. LDF/STF instructions with Rn = PC |
| 30 | depend on the PC being correct, as they use PC+8 in their |
| 31 | address calculations. */ |
| 32 | unsigned int *userRegisters = GET_USERREG(); |
| 33 | unsigned int val = userRegisters[nReg]; |
| 34 | if (REG_PC == nReg) val -= 4; |
| 35 | return val; |
| 36 | } |
| 37 | |
| 38 | extern __inline__ |
| 39 | void writeRegister(const unsigned int nReg, const unsigned int val) |
| 40 | { |
| 41 | unsigned int *userRegisters = GET_USERREG(); |
| 42 | userRegisters[nReg] = val; |
| 43 | } |
| 44 | |
| 45 | extern __inline__ |
| 46 | unsigned int readCPSR(void) |
| 47 | { |
| 48 | return(readRegister(REG_CPSR)); |
| 49 | } |
| 50 | |
| 51 | extern __inline__ |
| 52 | void writeCPSR(const unsigned int val) |
| 53 | { |
| 54 | writeRegister(REG_CPSR,val); |
| 55 | } |
| 56 | |
| 57 | extern __inline__ |
| 58 | unsigned int readConditionCodes(void) |
| 59 | { |
| 60 | #ifdef __FPEM_TEST__ |
| 61 | return(0); |
| 62 | #else |
| 63 | return(readCPSR() & CC_MASK); |
| 64 | #endif |
| 65 | } |
| 66 | |
| 67 | extern __inline__ |
| 68 | void writeConditionCodes(const unsigned int val) |
| 69 | { |
| 70 | unsigned int *userRegisters = GET_USERREG(); |
| 71 | unsigned int rval; |
| 72 | /* |
| 73 | * Operate directly on userRegisters since |
| 74 | * the CPSR may be the PC register itself. |
| 75 | */ |
| 76 | rval = userRegisters[REG_CPSR] & ~CC_MASK; |
| 77 | userRegisters[REG_CPSR] = rval | (val & CC_MASK); |
| 78 | } |
| 79 | |
| 80 | extern __inline__ |
| 81 | unsigned int readMemoryInt(unsigned int *pMem) |
| 82 | { |
| 83 | return *pMem; |
| 84 | } |