isa.cc (7427:1267715c2112) isa.cc (7436:b578349f9371)
1/*
2 * Copyright (c) 2010 ARM Limited
3 * All rights reserved
4 *
5 * The license below extends only to copyright in the software and shall
6 * not be construed as granting a license to any other intellectual
7 * property including but not limited to intellectual property relating
8 * to a hardware implementation of the functionality of the software
9 * licensed hereunder. You may use the software subject to the license
10 * terms below provided that you ensure that this notice is replicated
11 * unmodified and in its entirety in all distributions of the software,
12 * modified or unmodified, in source code or in binary form.
13 *
14 * Redistribution and use in source and binary forms, with or without
15 * modification, are permitted provided that the following conditions are
16 * met: redistributions of source code must retain the above copyright
17 * notice, this list of conditions and the following disclaimer;
18 * redistributions in binary form must reproduce the above copyright
19 * notice, this list of conditions and the following disclaimer in the
20 * documentation and/or other materials provided with the distribution;
21 * neither the name of the copyright holders nor the names of its
22 * contributors may be used to endorse or promote products derived from
23 * this software without specific prior written permission.
24 *
25 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
26 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
27 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
28 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
29 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
30 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
31 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
32 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
33 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
34 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
35 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
36 *
37 * Authors: Gabe Black
38 * Ali Saidi
39 */
40
41#include "arch/arm/isa.hh"
42
43namespace ArmISA
44{
45
46void
47ISA::clear()
48{
49 SCTLR sctlr_rst = miscRegs[MISCREG_SCTLR_RST];
50
51 memset(miscRegs, 0, sizeof(miscRegs));
52 CPSR cpsr = 0;
53 cpsr.mode = MODE_USER;
54 miscRegs[MISCREG_CPSR] = cpsr;
55 updateRegMap(cpsr);
56
57 SCTLR sctlr = 0;
58 sctlr.nmfi = (bool)sctlr_rst.nmfi;
59 sctlr.v = (bool)sctlr_rst.v;
60 sctlr.u = 1;
61 sctlr.xp = 1;
62 sctlr.rao2 = 1;
63 sctlr.rao3 = 1;
64 sctlr.rao4 = 1;
65 miscRegs[MISCREG_SCTLR] = sctlr;
66 miscRegs[MISCREG_SCTLR_RST] = sctlr_rst;
67
68
69 /*
70 * Technically this should be 0, but we don't support those
71 * settings.
72 */
73 CPACR cpacr = 0;
74 // Enable CP 10, 11
75 cpacr.cp10 = 0x3;
76 cpacr.cp11 = 0x3;
77 miscRegs[MISCREG_CPACR] = cpacr;
78
79 /* Start with an event in the mailbox */
80 miscRegs[MISCREG_SEV_MAILBOX] = 1;
81
82 /*
83 * Implemented = '5' from "M5",
84 * Variant = 0,
85 */
86 miscRegs[MISCREG_MIDR] =
87 (0x35 << 24) | //Implementor is '5' from "M5"
88 (0 << 20) | //Variant
89 (0xf << 16) | //Architecture from CPUID scheme
90 (0 << 4) | //Primary part number
91 (0 << 0) | //Revision
92 0;
93
94 // Separate Instruction and Data TLBs.
95 miscRegs[MISCREG_TLBTR] = 1;
96
97 MVFR0 mvfr0 = 0;
98 mvfr0.advSimdRegisters = 2;
99 mvfr0.singlePrecision = 2;
100 mvfr0.doublePrecision = 2;
101 mvfr0.vfpExceptionTrapping = 0;
102 mvfr0.divide = 1;
103 mvfr0.squareRoot = 1;
104 mvfr0.shortVectors = 1;
105 mvfr0.roundingModes = 1;
106 miscRegs[MISCREG_MVFR0] = mvfr0;
107
108 MVFR1 mvfr1 = 0;
109 mvfr1.flushToZero = 1;
110 mvfr1.defaultNaN = 1;
111 mvfr1.advSimdLoadStore = 1;
112 mvfr1.advSimdInteger = 1;
113 mvfr1.advSimdSinglePrecision = 1;
114 mvfr1.advSimdHalfPrecision = 1;
115 mvfr1.vfpHalfPrecision = 1;
116 miscRegs[MISCREG_MVFR1] = mvfr1;
117
118 miscRegs[MISCREG_MPIDR] = 0;
119
1/*
2 * Copyright (c) 2010 ARM Limited
3 * All rights reserved
4 *
5 * The license below extends only to copyright in the software and shall
6 * not be construed as granting a license to any other intellectual
7 * property including but not limited to intellectual property relating
8 * to a hardware implementation of the functionality of the software
9 * licensed hereunder. You may use the software subject to the license
10 * terms below provided that you ensure that this notice is replicated
11 * unmodified and in its entirety in all distributions of the software,
12 * modified or unmodified, in source code or in binary form.
13 *
14 * Redistribution and use in source and binary forms, with or without
15 * modification, are permitted provided that the following conditions are
16 * met: redistributions of source code must retain the above copyright
17 * notice, this list of conditions and the following disclaimer;
18 * redistributions in binary form must reproduce the above copyright
19 * notice, this list of conditions and the following disclaimer in the
20 * documentation and/or other materials provided with the distribution;
21 * neither the name of the copyright holders nor the names of its
22 * contributors may be used to endorse or promote products derived from
23 * this software without specific prior written permission.
24 *
25 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
26 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
27 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
28 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
29 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
30 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
31 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
32 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
33 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
34 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
35 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
36 *
37 * Authors: Gabe Black
38 * Ali Saidi
39 */
40
41#include "arch/arm/isa.hh"
42
43namespace ArmISA
44{
45
46void
47ISA::clear()
48{
49 SCTLR sctlr_rst = miscRegs[MISCREG_SCTLR_RST];
50
51 memset(miscRegs, 0, sizeof(miscRegs));
52 CPSR cpsr = 0;
53 cpsr.mode = MODE_USER;
54 miscRegs[MISCREG_CPSR] = cpsr;
55 updateRegMap(cpsr);
56
57 SCTLR sctlr = 0;
58 sctlr.nmfi = (bool)sctlr_rst.nmfi;
59 sctlr.v = (bool)sctlr_rst.v;
60 sctlr.u = 1;
61 sctlr.xp = 1;
62 sctlr.rao2 = 1;
63 sctlr.rao3 = 1;
64 sctlr.rao4 = 1;
65 miscRegs[MISCREG_SCTLR] = sctlr;
66 miscRegs[MISCREG_SCTLR_RST] = sctlr_rst;
67
68
69 /*
70 * Technically this should be 0, but we don't support those
71 * settings.
72 */
73 CPACR cpacr = 0;
74 // Enable CP 10, 11
75 cpacr.cp10 = 0x3;
76 cpacr.cp11 = 0x3;
77 miscRegs[MISCREG_CPACR] = cpacr;
78
79 /* Start with an event in the mailbox */
80 miscRegs[MISCREG_SEV_MAILBOX] = 1;
81
82 /*
83 * Implemented = '5' from "M5",
84 * Variant = 0,
85 */
86 miscRegs[MISCREG_MIDR] =
87 (0x35 << 24) | //Implementor is '5' from "M5"
88 (0 << 20) | //Variant
89 (0xf << 16) | //Architecture from CPUID scheme
90 (0 << 4) | //Primary part number
91 (0 << 0) | //Revision
92 0;
93
94 // Separate Instruction and Data TLBs.
95 miscRegs[MISCREG_TLBTR] = 1;
96
97 MVFR0 mvfr0 = 0;
98 mvfr0.advSimdRegisters = 2;
99 mvfr0.singlePrecision = 2;
100 mvfr0.doublePrecision = 2;
101 mvfr0.vfpExceptionTrapping = 0;
102 mvfr0.divide = 1;
103 mvfr0.squareRoot = 1;
104 mvfr0.shortVectors = 1;
105 mvfr0.roundingModes = 1;
106 miscRegs[MISCREG_MVFR0] = mvfr0;
107
108 MVFR1 mvfr1 = 0;
109 mvfr1.flushToZero = 1;
110 mvfr1.defaultNaN = 1;
111 mvfr1.advSimdLoadStore = 1;
112 mvfr1.advSimdInteger = 1;
113 mvfr1.advSimdSinglePrecision = 1;
114 mvfr1.advSimdHalfPrecision = 1;
115 mvfr1.vfpHalfPrecision = 1;
116 miscRegs[MISCREG_MVFR1] = mvfr1;
117
118 miscRegs[MISCREG_MPIDR] = 0;
119
120 // Reset values of PRRR and NMRR are implementation dependent
121
122 miscRegs[MISCREG_PRRR] =
123 (1 << 19) | // 19
124 (0 << 18) | // 18
125 (0 << 17) | // 17
126 (1 << 16) | // 16
127 (2 << 14) | // 15:14
128 (0 << 12) | // 13:12
129 (2 << 10) | // 11:10
130 (2 << 8) | // 9:8
131 (2 << 6) | // 7:6
132 (2 << 4) | // 5:4
133 (1 << 2) | // 3:2
134 0; // 1:0
135 miscRegs[MISCREG_NMRR] =
136 (1 << 30) | // 31:30
137 (0 << 26) | // 27:26
138 (0 << 24) | // 25:24
139 (3 << 22) | // 23:22
140 (2 << 20) | // 21:20
141 (0 << 18) | // 19:18
142 (0 << 16) | // 17:16
143 (1 << 14) | // 15:14
144 (0 << 12) | // 13:12
145 (2 << 10) | // 11:10
146 (0 << 8) | // 9:8
147 (3 << 6) | // 7:6
148 (2 << 4) | // 5:4
149 (0 << 2) | // 3:2
150 0; // 1:0
151
120 //XXX We need to initialize the rest of the state.
121}
122
123MiscReg
124ISA::readMiscRegNoEffect(int misc_reg)
125{
126 assert(misc_reg < NumMiscRegs);
127 if (misc_reg == MISCREG_SPSR) {
128 CPSR cpsr = miscRegs[MISCREG_CPSR];
129 switch (cpsr.mode) {
130 case MODE_USER:
131 return miscRegs[MISCREG_SPSR];
132 case MODE_FIQ:
133 return miscRegs[MISCREG_SPSR_FIQ];
134 case MODE_IRQ:
135 return miscRegs[MISCREG_SPSR_IRQ];
136 case MODE_SVC:
137 return miscRegs[MISCREG_SPSR_SVC];
138 case MODE_MON:
139 return miscRegs[MISCREG_SPSR_MON];
140 case MODE_ABORT:
141 return miscRegs[MISCREG_SPSR_ABT];
142 case MODE_UNDEFINED:
143 return miscRegs[MISCREG_SPSR_UND];
144 default:
145 return miscRegs[MISCREG_SPSR];
146 }
147 }
148 return miscRegs[misc_reg];
149}
150
151
152MiscReg
153ISA::readMiscReg(int misc_reg, ThreadContext *tc)
154{
155 if (misc_reg == MISCREG_CPSR) {
156 CPSR cpsr = miscRegs[misc_reg];
157 Addr pc = tc->readPC();
158 if (pc & (ULL(1) << PcJBitShift))
159 cpsr.j = 1;
160 else
161 cpsr.j = 0;
162 if (pc & (ULL(1) << PcTBitShift))
163 cpsr.t = 1;
164 else
165 cpsr.t = 0;
166 return cpsr;
167 }
168 if (misc_reg >= MISCREG_CP15_UNIMP_START &&
169 misc_reg < MISCREG_CP15_END) {
170 panic("Unimplemented CP15 register %s read.\n",
171 miscRegName[misc_reg]);
172 }
173 switch (misc_reg) {
174 case MISCREG_CLIDR:
175 warn("The clidr register always reports 0 caches.\n");
176 break;
177 case MISCREG_CCSIDR:
178 warn("The ccsidr register isn't implemented and "
179 "always reads as 0.\n");
180 break;
181 case MISCREG_ID_PFR0:
182 return 0x1031; // ThumbEE | !Jazelle | Thumb | ARM
183 }
184 return readMiscRegNoEffect(misc_reg);
185}
186
187void
188ISA::setMiscRegNoEffect(int misc_reg, const MiscReg &val)
189{
190 assert(misc_reg < NumMiscRegs);
191 if (misc_reg == MISCREG_SPSR) {
192 CPSR cpsr = miscRegs[MISCREG_CPSR];
193 switch (cpsr.mode) {
194 case MODE_USER:
195 miscRegs[MISCREG_SPSR] = val;
196 return;
197 case MODE_FIQ:
198 miscRegs[MISCREG_SPSR_FIQ] = val;
199 return;
200 case MODE_IRQ:
201 miscRegs[MISCREG_SPSR_IRQ] = val;
202 return;
203 case MODE_SVC:
204 miscRegs[MISCREG_SPSR_SVC] = val;
205 return;
206 case MODE_MON:
207 miscRegs[MISCREG_SPSR_MON] = val;
208 return;
209 case MODE_ABORT:
210 miscRegs[MISCREG_SPSR_ABT] = val;
211 return;
212 case MODE_UNDEFINED:
213 miscRegs[MISCREG_SPSR_UND] = val;
214 return;
215 default:
216 miscRegs[MISCREG_SPSR] = val;
217 return;
218 }
219 }
220 miscRegs[misc_reg] = val;
221}
222
223void
224ISA::setMiscReg(int misc_reg, const MiscReg &val, ThreadContext *tc)
225{
226 MiscReg newVal = val;
227 if (misc_reg == MISCREG_CPSR) {
228 updateRegMap(val);
229 CPSR cpsr = val;
230 DPRINTF(Arm, "Updating CPSR to %#x f:%d i:%d a:%d mode:%#x\n",
231 cpsr, cpsr.f, cpsr.i, cpsr.a, cpsr.mode);
232 Addr npc = tc->readNextPC() & ~PcModeMask;
233 if (cpsr.j)
234 npc = npc | (ULL(1) << PcJBitShift);
235 if (cpsr.t)
236 npc = npc | (ULL(1) << PcTBitShift);
237
238 tc->setNextPC(npc);
239 } else if (misc_reg >= MISCREG_CP15_UNIMP_START &&
240 misc_reg < MISCREG_CP15_END) {
241 panic("Unimplemented CP15 register %s wrote with %#x.\n",
242 miscRegName[misc_reg], val);
243 } else {
244 switch (misc_reg) {
245 case MISCREG_ITSTATE:
246 {
247 ITSTATE itstate = newVal;
248 CPSR cpsr = miscRegs[MISCREG_CPSR];
249 cpsr.it1 = itstate.bottom2;
250 cpsr.it2 = itstate.top6;
251 miscRegs[MISCREG_CPSR] = cpsr;
252 DPRINTF(MiscRegs,
253 "Updating ITSTATE -> %#x in CPSR -> %#x.\n",
254 (uint8_t)itstate, (uint32_t)cpsr);
255 }
256 break;
257 case MISCREG_CPACR:
258 {
259 CPACR newCpacr = 0;
260 CPACR valCpacr = val;
261 newCpacr.cp10 = valCpacr.cp10;
262 newCpacr.cp11 = valCpacr.cp11;
263 if (newCpacr.cp10 != 0x3 || newCpacr.cp11 != 3) {
264 panic("Disabling coprocessors isn't implemented.\n");
265 }
266 newVal = newCpacr;
267 }
268 break;
269 case MISCREG_CSSELR:
270 warn("The csselr register isn't implemented.\n");
271 break;
272 case MISCREG_FPSCR:
273 {
274 const uint32_t ones = (uint32_t)(-1);
275 FPSCR fpscrMask = 0;
276 fpscrMask.ioc = ones;
277 fpscrMask.dzc = ones;
278 fpscrMask.ofc = ones;
279 fpscrMask.ufc = ones;
280 fpscrMask.ixc = ones;
281 fpscrMask.idc = ones;
282 fpscrMask.len = ones;
283 fpscrMask.stride = ones;
284 fpscrMask.rMode = ones;
285 fpscrMask.fz = ones;
286 fpscrMask.dn = ones;
287 fpscrMask.ahp = ones;
288 fpscrMask.qc = ones;
289 fpscrMask.v = ones;
290 fpscrMask.c = ones;
291 fpscrMask.z = ones;
292 fpscrMask.n = ones;
293 newVal = (newVal & (uint32_t)fpscrMask) |
294 (miscRegs[MISCREG_FPSCR] & ~(uint32_t)fpscrMask);
295 }
296 break;
297 case MISCREG_FPEXC:
298 {
299 const uint32_t fpexcMask = 0x60000000;
300 newVal = (newVal & fpexcMask) |
301 (miscRegs[MISCREG_FPEXC] & ~fpexcMask);
302 }
303 break;
304 case MISCREG_SCTLR:
305 {
306 DPRINTF(MiscRegs, "Writing SCTLR: %#x\n", newVal);
307 SCTLR sctlr = miscRegs[MISCREG_SCTLR];
308 SCTLR new_sctlr = newVal;
309 new_sctlr.nmfi = (bool)sctlr.nmfi;
310 miscRegs[MISCREG_SCTLR] = (MiscReg)new_sctlr;
311 return;
312 }
313 case MISCREG_TLBTR:
314 case MISCREG_MVFR0:
315 case MISCREG_MVFR1:
316 case MISCREG_MPIDR:
317 case MISCREG_FPSID:
318 return;
319 case MISCREG_TLBIALLIS:
320 case MISCREG_TLBIALL:
321 warn("Need to flush all TLBs in MP\n");
322 tc->getITBPtr()->flushAll();
323 tc->getDTBPtr()->flushAll();
324 return;
325 case MISCREG_ITLBIALL:
326 tc->getITBPtr()->flushAll();
327 return;
328 case MISCREG_DTLBIALL:
329 tc->getDTBPtr()->flushAll();
330 return;
331 case MISCREG_TLBIMVAIS:
332 case MISCREG_TLBIMVA:
333 warn("Need to flush all TLBs in MP\n");
334 tc->getITBPtr()->flushMvaAsid(mbits(newVal, 31, 12),
335 bits(newVal, 7,0));
336 tc->getDTBPtr()->flushMvaAsid(mbits(newVal, 31, 12),
337 bits(newVal, 7,0));
338 return;
339 case MISCREG_TLBIASIDIS:
340 case MISCREG_TLBIASID:
341 warn("Need to flush all TLBs in MP\n");
342 tc->getITBPtr()->flushAsid(bits(newVal, 7,0));
343 tc->getDTBPtr()->flushAsid(bits(newVal, 7,0));
344 return;
345 case MISCREG_TLBIMVAAIS:
346 case MISCREG_TLBIMVAA:
347 warn("Need to flush all TLBs in MP\n");
348 tc->getITBPtr()->flushMva(mbits(newVal, 31,12));
349 tc->getDTBPtr()->flushMva(mbits(newVal, 31,12));
350 return;
351 case MISCREG_ITLBIMVA:
352 tc->getITBPtr()->flushMvaAsid(mbits(newVal, 31, 12),
353 bits(newVal, 7,0));
354 return;
355 case MISCREG_DTLBIMVA:
356 tc->getDTBPtr()->flushMvaAsid(mbits(newVal, 31, 12),
357 bits(newVal, 7,0));
358 return;
359 case MISCREG_ITLBIASID:
360 tc->getITBPtr()->flushAsid(bits(newVal, 7,0));
361 return;
362 case MISCREG_DTLBIASID:
363 tc->getDTBPtr()->flushAsid(bits(newVal, 7,0));
364 return;
152 //XXX We need to initialize the rest of the state.
153}
154
155MiscReg
156ISA::readMiscRegNoEffect(int misc_reg)
157{
158 assert(misc_reg < NumMiscRegs);
159 if (misc_reg == MISCREG_SPSR) {
160 CPSR cpsr = miscRegs[MISCREG_CPSR];
161 switch (cpsr.mode) {
162 case MODE_USER:
163 return miscRegs[MISCREG_SPSR];
164 case MODE_FIQ:
165 return miscRegs[MISCREG_SPSR_FIQ];
166 case MODE_IRQ:
167 return miscRegs[MISCREG_SPSR_IRQ];
168 case MODE_SVC:
169 return miscRegs[MISCREG_SPSR_SVC];
170 case MODE_MON:
171 return miscRegs[MISCREG_SPSR_MON];
172 case MODE_ABORT:
173 return miscRegs[MISCREG_SPSR_ABT];
174 case MODE_UNDEFINED:
175 return miscRegs[MISCREG_SPSR_UND];
176 default:
177 return miscRegs[MISCREG_SPSR];
178 }
179 }
180 return miscRegs[misc_reg];
181}
182
183
184MiscReg
185ISA::readMiscReg(int misc_reg, ThreadContext *tc)
186{
187 if (misc_reg == MISCREG_CPSR) {
188 CPSR cpsr = miscRegs[misc_reg];
189 Addr pc = tc->readPC();
190 if (pc & (ULL(1) << PcJBitShift))
191 cpsr.j = 1;
192 else
193 cpsr.j = 0;
194 if (pc & (ULL(1) << PcTBitShift))
195 cpsr.t = 1;
196 else
197 cpsr.t = 0;
198 return cpsr;
199 }
200 if (misc_reg >= MISCREG_CP15_UNIMP_START &&
201 misc_reg < MISCREG_CP15_END) {
202 panic("Unimplemented CP15 register %s read.\n",
203 miscRegName[misc_reg]);
204 }
205 switch (misc_reg) {
206 case MISCREG_CLIDR:
207 warn("The clidr register always reports 0 caches.\n");
208 break;
209 case MISCREG_CCSIDR:
210 warn("The ccsidr register isn't implemented and "
211 "always reads as 0.\n");
212 break;
213 case MISCREG_ID_PFR0:
214 return 0x1031; // ThumbEE | !Jazelle | Thumb | ARM
215 }
216 return readMiscRegNoEffect(misc_reg);
217}
218
219void
220ISA::setMiscRegNoEffect(int misc_reg, const MiscReg &val)
221{
222 assert(misc_reg < NumMiscRegs);
223 if (misc_reg == MISCREG_SPSR) {
224 CPSR cpsr = miscRegs[MISCREG_CPSR];
225 switch (cpsr.mode) {
226 case MODE_USER:
227 miscRegs[MISCREG_SPSR] = val;
228 return;
229 case MODE_FIQ:
230 miscRegs[MISCREG_SPSR_FIQ] = val;
231 return;
232 case MODE_IRQ:
233 miscRegs[MISCREG_SPSR_IRQ] = val;
234 return;
235 case MODE_SVC:
236 miscRegs[MISCREG_SPSR_SVC] = val;
237 return;
238 case MODE_MON:
239 miscRegs[MISCREG_SPSR_MON] = val;
240 return;
241 case MODE_ABORT:
242 miscRegs[MISCREG_SPSR_ABT] = val;
243 return;
244 case MODE_UNDEFINED:
245 miscRegs[MISCREG_SPSR_UND] = val;
246 return;
247 default:
248 miscRegs[MISCREG_SPSR] = val;
249 return;
250 }
251 }
252 miscRegs[misc_reg] = val;
253}
254
255void
256ISA::setMiscReg(int misc_reg, const MiscReg &val, ThreadContext *tc)
257{
258 MiscReg newVal = val;
259 if (misc_reg == MISCREG_CPSR) {
260 updateRegMap(val);
261 CPSR cpsr = val;
262 DPRINTF(Arm, "Updating CPSR to %#x f:%d i:%d a:%d mode:%#x\n",
263 cpsr, cpsr.f, cpsr.i, cpsr.a, cpsr.mode);
264 Addr npc = tc->readNextPC() & ~PcModeMask;
265 if (cpsr.j)
266 npc = npc | (ULL(1) << PcJBitShift);
267 if (cpsr.t)
268 npc = npc | (ULL(1) << PcTBitShift);
269
270 tc->setNextPC(npc);
271 } else if (misc_reg >= MISCREG_CP15_UNIMP_START &&
272 misc_reg < MISCREG_CP15_END) {
273 panic("Unimplemented CP15 register %s wrote with %#x.\n",
274 miscRegName[misc_reg], val);
275 } else {
276 switch (misc_reg) {
277 case MISCREG_ITSTATE:
278 {
279 ITSTATE itstate = newVal;
280 CPSR cpsr = miscRegs[MISCREG_CPSR];
281 cpsr.it1 = itstate.bottom2;
282 cpsr.it2 = itstate.top6;
283 miscRegs[MISCREG_CPSR] = cpsr;
284 DPRINTF(MiscRegs,
285 "Updating ITSTATE -> %#x in CPSR -> %#x.\n",
286 (uint8_t)itstate, (uint32_t)cpsr);
287 }
288 break;
289 case MISCREG_CPACR:
290 {
291 CPACR newCpacr = 0;
292 CPACR valCpacr = val;
293 newCpacr.cp10 = valCpacr.cp10;
294 newCpacr.cp11 = valCpacr.cp11;
295 if (newCpacr.cp10 != 0x3 || newCpacr.cp11 != 3) {
296 panic("Disabling coprocessors isn't implemented.\n");
297 }
298 newVal = newCpacr;
299 }
300 break;
301 case MISCREG_CSSELR:
302 warn("The csselr register isn't implemented.\n");
303 break;
304 case MISCREG_FPSCR:
305 {
306 const uint32_t ones = (uint32_t)(-1);
307 FPSCR fpscrMask = 0;
308 fpscrMask.ioc = ones;
309 fpscrMask.dzc = ones;
310 fpscrMask.ofc = ones;
311 fpscrMask.ufc = ones;
312 fpscrMask.ixc = ones;
313 fpscrMask.idc = ones;
314 fpscrMask.len = ones;
315 fpscrMask.stride = ones;
316 fpscrMask.rMode = ones;
317 fpscrMask.fz = ones;
318 fpscrMask.dn = ones;
319 fpscrMask.ahp = ones;
320 fpscrMask.qc = ones;
321 fpscrMask.v = ones;
322 fpscrMask.c = ones;
323 fpscrMask.z = ones;
324 fpscrMask.n = ones;
325 newVal = (newVal & (uint32_t)fpscrMask) |
326 (miscRegs[MISCREG_FPSCR] & ~(uint32_t)fpscrMask);
327 }
328 break;
329 case MISCREG_FPEXC:
330 {
331 const uint32_t fpexcMask = 0x60000000;
332 newVal = (newVal & fpexcMask) |
333 (miscRegs[MISCREG_FPEXC] & ~fpexcMask);
334 }
335 break;
336 case MISCREG_SCTLR:
337 {
338 DPRINTF(MiscRegs, "Writing SCTLR: %#x\n", newVal);
339 SCTLR sctlr = miscRegs[MISCREG_SCTLR];
340 SCTLR new_sctlr = newVal;
341 new_sctlr.nmfi = (bool)sctlr.nmfi;
342 miscRegs[MISCREG_SCTLR] = (MiscReg)new_sctlr;
343 return;
344 }
345 case MISCREG_TLBTR:
346 case MISCREG_MVFR0:
347 case MISCREG_MVFR1:
348 case MISCREG_MPIDR:
349 case MISCREG_FPSID:
350 return;
351 case MISCREG_TLBIALLIS:
352 case MISCREG_TLBIALL:
353 warn("Need to flush all TLBs in MP\n");
354 tc->getITBPtr()->flushAll();
355 tc->getDTBPtr()->flushAll();
356 return;
357 case MISCREG_ITLBIALL:
358 tc->getITBPtr()->flushAll();
359 return;
360 case MISCREG_DTLBIALL:
361 tc->getDTBPtr()->flushAll();
362 return;
363 case MISCREG_TLBIMVAIS:
364 case MISCREG_TLBIMVA:
365 warn("Need to flush all TLBs in MP\n");
366 tc->getITBPtr()->flushMvaAsid(mbits(newVal, 31, 12),
367 bits(newVal, 7,0));
368 tc->getDTBPtr()->flushMvaAsid(mbits(newVal, 31, 12),
369 bits(newVal, 7,0));
370 return;
371 case MISCREG_TLBIASIDIS:
372 case MISCREG_TLBIASID:
373 warn("Need to flush all TLBs in MP\n");
374 tc->getITBPtr()->flushAsid(bits(newVal, 7,0));
375 tc->getDTBPtr()->flushAsid(bits(newVal, 7,0));
376 return;
377 case MISCREG_TLBIMVAAIS:
378 case MISCREG_TLBIMVAA:
379 warn("Need to flush all TLBs in MP\n");
380 tc->getITBPtr()->flushMva(mbits(newVal, 31,12));
381 tc->getDTBPtr()->flushMva(mbits(newVal, 31,12));
382 return;
383 case MISCREG_ITLBIMVA:
384 tc->getITBPtr()->flushMvaAsid(mbits(newVal, 31, 12),
385 bits(newVal, 7,0));
386 return;
387 case MISCREG_DTLBIMVA:
388 tc->getDTBPtr()->flushMvaAsid(mbits(newVal, 31, 12),
389 bits(newVal, 7,0));
390 return;
391 case MISCREG_ITLBIASID:
392 tc->getITBPtr()->flushAsid(bits(newVal, 7,0));
393 return;
394 case MISCREG_DTLBIASID:
395 tc->getDTBPtr()->flushAsid(bits(newVal, 7,0));
396 return;
397 case MISCREG_V2PCWPR:
398 case MISCREG_V2PCWPW:
399 case MISCREG_V2PCWUR:
400 case MISCREG_V2PCWUW:
401 case MISCREG_V2POWPR:
402 case MISCREG_V2POWPW:
403 case MISCREG_V2POWUR:
404 case MISCREG_V2POWUW:
405 {
406 RequestPtr req = new Request;
407 unsigned flags;
408 BaseTLB::Mode mode;
409 Fault fault;
410 switch(misc_reg) {
411 case MISCREG_V2PCWPR:
412 flags = TLB::MustBeOne;
413 mode = BaseTLB::Read;
414 break;
415 case MISCREG_V2PCWPW:
416 flags = TLB::MustBeOne;
417 mode = BaseTLB::Write;
418 break;
419 case MISCREG_V2PCWUR:
420 flags = TLB::MustBeOne | TLB::UserMode;
421 mode = BaseTLB::Read;
422 break;
423 case MISCREG_V2PCWUW:
424 flags = TLB::MustBeOne | TLB::UserMode;
425 mode = BaseTLB::Write;
426 break;
427 case MISCREG_V2POWPR:
428 case MISCREG_V2POWPW:
429 case MISCREG_V2POWUR:
430 case MISCREG_V2POWUW:
431 panic("Security Extensions not implemented!");
432 }
433 req->setVirt(0, val, 1, flags, tc->readPC());
434 fault = tc->getDTBPtr()->translateAtomic(req, tc, mode);
435 if (fault == NoFault) {
436 miscRegs[MISCREG_PAR] =
437 (req->getPaddr() & 0xfffff000) |
438 (tc->getDTBPtr()->getAttr() );
439 DPRINTF(MiscRegs,
440 "MISCREG: Translated addr 0x%08x: PAR: 0x%08x\n",
441 val, miscRegs[MISCREG_PAR]);
442 }
443 else {
444 // Set fault bit and FSR
445 FSR fsr = miscRegs[MISCREG_DFSR];
446 miscRegs[MISCREG_PAR] =
447 (fsr.ext << 6) |
448 (fsr.fsHigh << 5) |
449 (fsr.fsLow << 1) |
450 0x1; // F bit
451 }
452 return;
453 }
365 }
366 }
367 setMiscRegNoEffect(misc_reg, newVal);
368}
369
370}
454 }
455 }
456 setMiscRegNoEffect(misc_reg, newVal);
457}
458
459}