faults.cc revision 7585
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 * Copyright (c) 2003-2005 The Regents of The University of Michigan
15 * Copyright (c) 2007-2008 The Florida State University
16 * All rights reserved.
17 *
18 * Redistribution and use in source and binary forms, with or without
19 * modification, are permitted provided that the following conditions are
20 * met: redistributions of source code must retain the above copyright
21 * notice, this list of conditions and the following disclaimer;
22 * redistributions in binary form must reproduce the above copyright
23 * notice, this list of conditions and the following disclaimer in the
24 * documentation and/or other materials provided with the distribution;
25 * neither the name of the copyright holders nor the names of its
26 * contributors may be used to endorse or promote products derived from
27 * this software without specific prior written permission.
28 *
29 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
30 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
31 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
32 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
33 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
34 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
35 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
36 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
37 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
38 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
39 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
40 *
41 * Authors: Ali Saidi
42 *          Gabe Black
43 */
44
45#include "arch/arm/faults.hh"
46#include "cpu/thread_context.hh"
47#include "cpu/base.hh"
48#include "base/trace.hh"
49
50namespace ArmISA
51{
52
53template<> ArmFault::FaultVals ArmFaultVals<Reset>::vals =
54    {"reset", 0x00, MODE_SVC, 0, 0, true, true};
55
56template<> ArmFault::FaultVals ArmFaultVals<UndefinedInstruction>::vals =
57    {"Undefined Instruction", 0x04, MODE_UNDEFINED, 4 ,2, false, false} ;
58
59template<> ArmFault::FaultVals ArmFaultVals<SupervisorCall>::vals =
60    {"Supervisor Call", 0x08, MODE_SVC, 4, 2, false, false};
61
62template<> ArmFault::FaultVals ArmFaultVals<PrefetchAbort>::vals =
63    {"Prefetch Abort", 0x0C, MODE_ABORT, 4, 4, true, false};
64
65template<> ArmFault::FaultVals ArmFaultVals<DataAbort>::vals =
66    {"Data Abort", 0x10, MODE_ABORT, 8, 8, true, false};
67
68template<> ArmFault::FaultVals ArmFaultVals<Interrupt>::vals =
69    {"IRQ", 0x18, MODE_IRQ, 4, 4, true, false};
70
71template<> ArmFault::FaultVals ArmFaultVals<FastInterrupt>::vals =
72    {"FIQ", 0x1C, MODE_FIQ, 4, 4, true, true};
73
74Addr
75ArmFault::getVector(ThreadContext *tc)
76{
77    // ARM ARM B1-3
78
79    SCTLR sctlr = tc->readMiscReg(MISCREG_SCTLR);
80
81    // panic if SCTLR.VE because I have no idea what to do with vectored
82    // interrupts
83    assert(!sctlr.ve);
84
85    if (!sctlr.v)
86        return offset();
87    return offset() + HighVecs;
88
89}
90
91#if FULL_SYSTEM
92
93void
94ArmFault::invoke(ThreadContext *tc)
95{
96    // ARM ARM B1.6.3
97    FaultBase::invoke(tc);
98    countStat()++;
99
100    SCTLR sctlr = tc->readMiscReg(MISCREG_SCTLR);
101    CPSR cpsr = tc->readMiscReg(MISCREG_CPSR);
102    CPSR saved_cpsr = tc->readMiscReg(MISCREG_CPSR) |
103                      tc->readIntReg(INTREG_CONDCODES);
104
105
106    cpsr.mode = nextMode();
107    cpsr.it1 = cpsr.it2 = 0;
108    cpsr.j = 0;
109
110    cpsr.t = sctlr.te;
111    cpsr.a = cpsr.a | abortDisable();
112    cpsr.f = cpsr.f | fiqDisable();
113    cpsr.i = 1;
114    cpsr.e = sctlr.ee;
115    tc->setMiscReg(MISCREG_CPSR, cpsr);
116    tc->setIntReg(INTREG_LR, tc->readPC() +
117            (saved_cpsr.t ? thumbPcOffset() : armPcOffset()));
118
119    switch (nextMode()) {
120      case MODE_FIQ:
121        tc->setMiscReg(MISCREG_SPSR_FIQ, saved_cpsr);
122        break;
123      case MODE_IRQ:
124        tc->setMiscReg(MISCREG_SPSR_IRQ, saved_cpsr);
125        break;
126      case MODE_SVC:
127        tc->setMiscReg(MISCREG_SPSR_SVC, saved_cpsr);
128        break;
129      case MODE_UNDEFINED:
130        tc->setMiscReg(MISCREG_SPSR_UND, saved_cpsr);
131        break;
132      case MODE_ABORT:
133        tc->setMiscReg(MISCREG_SPSR_ABT, saved_cpsr);
134        break;
135      default:
136        panic("unknown Mode\n");
137    }
138
139    Addr pc M5_VAR_USED = tc->readPC();
140    Addr newPc = getVector(tc) | (sctlr.te ? (ULL(1) << PcTBitShift) : 0);
141    DPRINTF(Faults, "Invoking Fault:%s cpsr:%#x PC:%#x lr:%#x newVec: %#x\n",
142            name(), cpsr, pc, tc->readIntReg(INTREG_LR), newPc);
143    tc->setPC(newPc);
144    tc->setNextPC(newPc + cpsr.t ? 2 : 4 );
145    tc->setMicroPC(0);
146    tc->setNextMicroPC(1);
147}
148
149void
150Reset::invoke(ThreadContext *tc)
151{
152    tc->getCpuPtr()->clearInterrupts();
153    tc->clearArchRegs();
154    ArmFault::invoke(tc);
155}
156
157#else
158
159void
160UndefinedInstruction::invoke(ThreadContext *tc)
161{
162    assert(unknown || mnemonic != NULL);
163    if (unknown) {
164        panic("Attempted to execute unknown instruction (inst 0x%08x)",
165              machInst);
166    } else {
167        panic("Attempted to execute unimplemented instruction "
168                "'%s' (inst 0x%08x)", mnemonic, machInst);
169    }
170}
171
172void
173SupervisorCall::invoke(ThreadContext *tc)
174{
175    // As of now, there isn't a 32 bit thumb version of this instruction.
176    assert(!machInst.bigThumb);
177    uint32_t callNum;
178    if (machInst.thumb) {
179        callNum = bits(machInst, 7, 0);
180    } else {
181        callNum = bits(machInst, 23, 0);
182    }
183    if (callNum == 0) {
184        callNum = tc->readIntReg(INTREG_R7);
185    }
186    tc->syscall(callNum);
187
188    // Advance the PC since that won't happen automatically.
189    tc->setPC(tc->readNextPC());
190    tc->setNextPC(tc->readNextNPC());
191    tc->setMicroPC(0);
192    tc->setNextMicroPC(1);
193}
194
195#endif // FULL_SYSTEM
196
197template<class T>
198void
199AbortFault<T>::invoke(ThreadContext *tc)
200{
201    ArmFaultVals<T>::invoke(tc);
202    FSR fsr = 0;
203    fsr.fsLow = bits(status, 3, 0);
204    fsr.fsHigh = bits(status, 4);
205    fsr.domain = domain;
206    fsr.wnr = (write ? 1 : 0);
207    fsr.ext = 0;
208    tc->setMiscReg(T::FsrIndex, fsr);
209    tc->setMiscReg(T::FarIndex, faultAddr);
210}
211
212template void AbortFault<PrefetchAbort>::invoke(ThreadContext *tc);
213template void AbortFault<DataAbort>::invoke(ThreadContext *tc);
214
215// return via SUBS pc, lr, xxx; rfe, movs, ldm
216
217
218
219} // namespace ArmISA
220
221