faults.cc revision 7741
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 74template<> ArmFault::FaultVals ArmFaultVals<FlushPipe>::vals = 75 {"Pipe Flush", 0x00, MODE_SVC, 0, 0, true, true}; // some dummy values 76 77Addr 78ArmFault::getVector(ThreadContext *tc) 79{ 80 // ARM ARM B1-3 81 82 SCTLR sctlr = tc->readMiscReg(MISCREG_SCTLR); 83 84 // panic if SCTLR.VE because I have no idea what to do with vectored 85 // interrupts 86 assert(!sctlr.ve); 87 88 if (!sctlr.v) 89 return offset(); 90 return offset() + HighVecs; 91 92} 93 94#if FULL_SYSTEM 95 96void 97ArmFault::invoke(ThreadContext *tc, StaticInstPtr inst) 98{ 99 // ARM ARM B1.6.3 100 FaultBase::invoke(tc); 101 countStat()++; 102 103 SCTLR sctlr = tc->readMiscReg(MISCREG_SCTLR); 104 CPSR cpsr = tc->readMiscReg(MISCREG_CPSR); 105 CPSR saved_cpsr = tc->readMiscReg(MISCREG_CPSR) | 106 tc->readIntReg(INTREG_CONDCODES); 107 Addr curPc M5_VAR_USED = tc->pcState().pc(); 108 109 110 cpsr.mode = nextMode(); 111 cpsr.it1 = cpsr.it2 = 0; 112 cpsr.j = 0; 113 114 cpsr.t = sctlr.te; 115 cpsr.a = cpsr.a | abortDisable(); 116 cpsr.f = cpsr.f | fiqDisable(); 117 cpsr.i = 1; 118 cpsr.e = sctlr.ee; 119 tc->setMiscReg(MISCREG_CPSR, cpsr); 120 tc->setIntReg(INTREG_LR, curPc + 121 (saved_cpsr.t ? thumbPcOffset() : armPcOffset())); 122 123 switch (nextMode()) { 124 case MODE_FIQ: 125 tc->setMiscReg(MISCREG_SPSR_FIQ, saved_cpsr); 126 break; 127 case MODE_IRQ: 128 tc->setMiscReg(MISCREG_SPSR_IRQ, saved_cpsr); 129 break; 130 case MODE_SVC: 131 tc->setMiscReg(MISCREG_SPSR_SVC, saved_cpsr); 132 break; 133 case MODE_UNDEFINED: 134 tc->setMiscReg(MISCREG_SPSR_UND, saved_cpsr); 135 break; 136 case MODE_ABORT: 137 tc->setMiscReg(MISCREG_SPSR_ABT, saved_cpsr); 138 break; 139 default: 140 panic("unknown Mode\n"); 141 } 142 143 Addr newPc = getVector(tc); 144 DPRINTF(Faults, "Invoking Fault:%s cpsr:%#x PC:%#x lr:%#x newVec: %#x\n", 145 name(), cpsr, curPc, tc->readIntReg(INTREG_LR), newPc); 146 PCState pc(newPc); 147 pc.thumb(cpsr.t); 148 pc.nextThumb(pc.thumb()); 149 pc.jazelle(cpsr.j); 150 pc.nextJazelle(pc.jazelle()); 151 tc->pcState(pc); 152} 153 154void 155Reset::invoke(ThreadContext *tc, StaticInstPtr inst) 156{ 157 tc->getCpuPtr()->clearInterrupts(); 158 tc->clearArchRegs(); 159 ArmFault::invoke(tc); 160} 161 162#else 163 164void 165UndefinedInstruction::invoke(ThreadContext *tc, StaticInstPtr inst) 166{ 167 // If the mnemonic isn't defined this has to be an unknown instruction. 168 assert(unknown || mnemonic != NULL); 169 if (disabled) { 170 panic("Attempted to execute disabled instruction " 171 "'%s' (inst 0x%08x)", mnemonic, machInst); 172 } else if (unknown) { 173 panic("Attempted to execute unknown instruction (inst 0x%08x)", 174 machInst); 175 } else { 176 panic("Attempted to execute unimplemented instruction " 177 "'%s' (inst 0x%08x)", mnemonic, machInst); 178 } 179} 180 181void 182SupervisorCall::invoke(ThreadContext *tc, StaticInstPtr inst) 183{ 184 // As of now, there isn't a 32 bit thumb version of this instruction. 185 assert(!machInst.bigThumb); 186 uint32_t callNum; 187 if (machInst.thumb) { 188 callNum = bits(machInst, 7, 0); 189 } else { 190 callNum = bits(machInst, 23, 0); 191 } 192 if (callNum == 0) { 193 callNum = tc->readIntReg(INTREG_R7); 194 } 195 tc->syscall(callNum); 196 197 // Advance the PC since that won't happen automatically. 198 PCState pc = tc->pcState(); 199 assert(inst); 200 inst->advancePC(pc); 201 tc->pcState(pc); 202} 203 204#endif // FULL_SYSTEM 205 206template<class T> 207void 208AbortFault<T>::invoke(ThreadContext *tc, StaticInstPtr inst) 209{ 210 ArmFaultVals<T>::invoke(tc); 211 FSR fsr = 0; 212 fsr.fsLow = bits(status, 3, 0); 213 fsr.fsHigh = bits(status, 4); 214 fsr.domain = domain; 215 fsr.wnr = (write ? 1 : 0); 216 fsr.ext = 0; 217 tc->setMiscReg(T::FsrIndex, fsr); 218 tc->setMiscReg(T::FarIndex, faultAddr); 219} 220 221void 222FlushPipe::invoke(ThreadContext *tc, StaticInstPtr inst) { 223 DPRINTF(Faults, "Invoking FlushPipe Fault\n"); 224 225 // Set the PC to the next instruction of the faulting instruction. 226 // Net effect is simply squashing all instructions behind and 227 // start refetching from the next instruction. 228 PCState pc = tc->pcState(); 229 assert(inst); 230 inst->advancePC(pc); 231 tc->pcState(pc); 232} 233 234template void AbortFault<PrefetchAbort>::invoke(ThreadContext *tc, 235 StaticInstPtr inst); 236template void AbortFault<DataAbort>::invoke(ThreadContext *tc, 237 StaticInstPtr inst); 238 239// return via SUBS pc, lr, xxx; rfe, movs, ldm 240 241} // namespace ArmISA 242