Commit | Line | Data |
---|---|---|
1da177e4 LT |
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. */ | |
b66da4a4 RK |
31 | struct pt_regs *regs = GET_USERREG(); |
32 | unsigned int val = regs->uregs[nReg]; | |
1da177e4 LT |
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 | { | |
b66da4a4 RK |
41 | struct pt_regs *regs = GET_USERREG(); |
42 | regs->uregs[nReg] = val; | |
1da177e4 LT |
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 | { | |
b66da4a4 | 66 | struct pt_regs *regs = GET_USERREG(); |
1da177e4 LT |
67 | unsigned long rval; |
68 | /* | |
69 | * Operate directly on userRegisters since | |
70 | * the CPSR may be the PC register itself. | |
71 | */ | |
b66da4a4 RK |
72 | rval = regs->ARM_cpsr & ~CC_MASK; |
73 | regs->ARM_cpsr = rval | (val & CC_MASK); | |
1da177e4 | 74 | } |