src/arch/arm/faults.cc

   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
  50 namespace ArmISA
  51 {
  52
  53 template<> ArmFaultBase::FaultVals ArmFault<Reset>::vals =
  54     {"reset", 0x00, MODE_SVC, 0, 0, true, true};
  55
  56 template<> ArmFaultBase::FaultVals ArmFault<UndefinedInstruction>::vals =
  57     {"Undefined Instruction", 0x04, MODE_UNDEFINED, 4 ,2, false, false} ;
  58
  59 template<> ArmFaultBase::FaultVals ArmFault<SupervisorCall>::vals =
  60     {"Supervisor Call", 0x08, MODE_SVC, 4, 2, false, false};
  61
  62 template<> ArmFaultBase::FaultVals ArmFault<PrefetchAbort>::vals =
  63     {"Prefetch Abort", 0x0C, MODE_ABORT, 4, 4, true, false};
  64
  65 template<> ArmFaultBase::FaultVals ArmFault<DataAbort>::vals =
  66     {"Data Abort", 0x10, MODE_ABORT, 8, 8, true, false};
  67
  68 template<> ArmFaultBase::FaultVals ArmFault<Interrupt>::vals =
  69     {"IRQ", 0x18, MODE_IRQ, 4, 4, true, false};
  70
  71 template<> ArmFaultBase::FaultVals ArmFault<FastInterrupt>::vals =
  72     {"FIQ", 0x1C, MODE_FIQ, 4, 4, true, true};
  73
  74 Addr
  75 ArmFaultBase::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
  93 void
  94 ArmFaultBase::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
 148 void
 149 UndefinedInstruction::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