faults.cc revision 7189
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<> ArmFaultBase::FaultVals ArmFault<Reset>::vals = 54 {"reset", 0x00, MODE_SVC, 0, 0, true, true}; 55 56template<> ArmFaultBase::FaultVals ArmFault<UndefinedInstruction>::vals = 57 {"Undefined Instruction", 0x04, MODE_UNDEFINED, 4 ,2, false, false} ; 58 59template<> ArmFaultBase::FaultVals ArmFault<SupervisorCall>::vals = 60 {"Supervisor Call", 0x08, MODE_SVC, 4, 2, false, false}; 61 62template<> ArmFaultBase::FaultVals ArmFault<PrefetchAbort>::vals = 63 {"Prefetch Abort", 0x0C, MODE_ABORT, 4, 4, true, false}; 64 65template<> ArmFaultBase::FaultVals ArmFault<DataAbort>::vals = 66 {"Data Abort", 0x10, MODE_ABORT, 8, 8, true, false}; 67 68template<> ArmFaultBase::FaultVals ArmFault<Interrupt>::vals = 69 {"IRQ", 0x18, MODE_IRQ, 4, 4, true, false}; 70 71template<> ArmFaultBase::FaultVals ArmFault<FastInterrupt>::vals = 72 {"FIQ", 0x1C, MODE_FIQ, 4, 4, true, true}; 73 74Addr 75ArmFaultBase::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 94ArmFaultBase::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 tc->setMiscReg(MISCREG_CPSR, cpsr); 115 tc->setIntReg(INTREG_LR, tc->readPC() + 116 (saved_cpsr.t ? thumbPcOffset() : armPcOffset())); 117 118 switch (nextMode()) { 119 case MODE_FIQ: 120 tc->setMiscReg(MISCREG_SPSR_FIQ, saved_cpsr); 121 break; 122 case MODE_IRQ: 123 tc->setMiscReg(MISCREG_SPSR_IRQ, saved_cpsr); 124 break; 125 case MODE_SVC: 126 tc->setMiscReg(MISCREG_SPSR_SVC, saved_cpsr); 127 break; 128 case MODE_UNDEFINED: 129 tc->setMiscReg(MISCREG_SPSR_UND, saved_cpsr); 130 break; 131 case MODE_ABORT: 132 tc->setMiscReg(MISCREG_SPSR_ABT, saved_cpsr); 133 break; 134 default: 135 panic("unknown Mode\n"); 136 } 137 138 Addr pc = tc->readPC(); 139 DPRINTF(Faults, "Invoking Fault: %s cpsr: %#x PC: %#x lr: %#x\n", 140 name(), cpsr, pc, tc->readIntReg(INTREG_LR)); 141 Addr newPc = getVector(tc) | (sctlr.te ? (ULL(1) << PcTBitShift) : 0); 142 tc->setPC(newPc); 143 tc->setNextPC(newPc + cpsr.t ? 2 : 4 ); 144} 145 146#else 147 148void 149UndefinedInstruction::invoke(ThreadContext *tc) 150{ 151 assert(unknown || mnemonic != NULL); 152 if (unknown) { 153 panic("Attempted to execute unknown instruction " 154 "(inst 0x%08x, opcode 0x%x, binary:%s)", 155 machInst, machInst.opcode, inst2string(machInst)); 156 } else { 157 panic("Attempted to execute unimplemented instruction '%s' " 158 "(inst 0x%08x, opcode 0x%x, binary:%s)", 159 mnemonic, machInst, machInst.opcode, inst2string(machInst)); 160 } 161} 162 163#endif // FULL_SYSTEM 164 165// return via SUBS pc, lr, xxx; rfe, movs, ldm 166 167 168 169} // namespace ArmISA 170 171