faults.cc revision 7720
12SN/A/*
21762SN/A * Copyright (c) 2003-2005 The Regents of The University of Michigan
32SN/A * All rights reserved.
42SN/A *
52SN/A * Redistribution and use in source and binary forms, with or without
62SN/A * modification, are permitted provided that the following conditions are
72SN/A * met: redistributions of source code must retain the above copyright
82SN/A * notice, this list of conditions and the following disclaimer;
92SN/A * redistributions in binary form must reproduce the above copyright
102SN/A * notice, this list of conditions and the following disclaimer in the
112SN/A * documentation and/or other materials provided with the distribution;
122SN/A * neither the name of the copyright holders nor the names of its
132SN/A * contributors may be used to endorse or promote products derived from
142SN/A * this software without specific prior written permission.
152SN/A *
162SN/A * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
172SN/A * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
182SN/A * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
192SN/A * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
202SN/A * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
212SN/A * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
222SN/A * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
232SN/A * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
242SN/A * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
252SN/A * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
262SN/A * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
272665Ssaidi@eecs.umich.edu *
282665Ssaidi@eecs.umich.edu * Authors: Gabe Black
292665Ssaidi@eecs.umich.edu *          Kevin Lim
302665Ssaidi@eecs.umich.edu */
312SN/A
322SN/A#include <algorithm>
332SN/A
342SN/A#include "arch/sparc/faults.hh"
352SN/A#include "arch/sparc/isa_traits.hh"
362SN/A#include "arch/sparc/types.hh"
3775SN/A#include "base/bitfield.hh"
382SN/A#include "base/trace.hh"
392439SN/A#include "config/full_system.hh"
402439SN/A#include "cpu/base.hh"
41603SN/A#include "cpu/thread_context.hh"
422986Sgblack@eecs.umich.edu#if !FULL_SYSTEM
43603SN/A#include "arch/sparc/process.hh"
442520SN/A#include "mem/page_table.hh"
452378SN/A#include "sim/process.hh"
462378SN/A#endif
47722SN/A
482521SN/Ausing namespace std;
492378SN/A
50312SN/Anamespace SparcISA
511634SN/A{
522680Sktlim@umich.edu
531634SN/Atemplate<> SparcFaultBase::FaultVals
542521SN/A    SparcFault<PowerOnReset>::vals =
552378SN/A    {"power_on_reset", 0x001, 0, {H, H, H}};
562378SN/A
57803SN/Atemplate<> SparcFaultBase::FaultVals
582378SN/A    SparcFault<WatchDogReset>::vals =
592SN/A    {"watch_dog_reset", 0x002, 120, {H, H, H}};
602378SN/A
612SN/Atemplate<> SparcFaultBase::FaultVals
622SN/A    SparcFault<ExternallyInitiatedReset>::vals =
632SN/A    {"externally_initiated_reset", 0x003, 110, {H, H, H}};
64603SN/A
652901Ssaidi@eecs.umich.edutemplate<> SparcFaultBase::FaultVals
662901Ssaidi@eecs.umich.edu    SparcFault<SoftwareInitiatedReset>::vals =
672901Ssaidi@eecs.umich.edu    {"software_initiated_reset", 0x004, 130, {SH, SH, H}};
682901Ssaidi@eecs.umich.edu
692901Ssaidi@eecs.umich.edutemplate<> SparcFaultBase::FaultVals
702901Ssaidi@eecs.umich.edu    SparcFault<REDStateException>::vals =
712902Ssaidi@eecs.umich.edu    {"RED_state_exception", 0x005, 1, {H, H, H}};
722902Ssaidi@eecs.umich.edu
732901Ssaidi@eecs.umich.edutemplate<> SparcFaultBase::FaultVals
742901Ssaidi@eecs.umich.edu    SparcFault<StoreError>::vals =
752901Ssaidi@eecs.umich.edu    {"store_error", 0x007, 201, {H, H, H}};
762901Ssaidi@eecs.umich.edu
772901Ssaidi@eecs.umich.edutemplate<> SparcFaultBase::FaultVals
782901Ssaidi@eecs.umich.edu    SparcFault<InstructionAccessException>::vals =
792901Ssaidi@eecs.umich.edu    {"instruction_access_exception", 0x008, 300, {H, H, H}};
802901Ssaidi@eecs.umich.edu
812901Ssaidi@eecs.umich.edu//XXX This trap is apparently dropped from ua2005
822521SN/A/*template<> SparcFaultBase::FaultVals
832SN/A    SparcFault<InstructionAccessMMUMiss>::vals =
842SN/A    {"inst_mmu", 0x009, 2, {H, H, H}};*/
852680Sktlim@umich.edu
861806SN/Atemplate<> SparcFaultBase::FaultVals
871806SN/A    SparcFault<InstructionAccessError>::vals =
881806SN/A    {"instruction_access_error", 0x00A, 400, {H, H, H}};
891806SN/A
902680Sktlim@umich.edutemplate<> SparcFaultBase::FaultVals
911806SN/A    SparcFault<IllegalInstruction>::vals =
921806SN/A    {"illegal_instruction", 0x010, 620, {H, H, H}};
931806SN/A
941806SN/Atemplate<> SparcFaultBase::FaultVals
95180SN/A    SparcFault<PrivilegedOpcode>::vals =
962378SN/A    {"privileged_opcode", 0x011, 700, {P, SH, SH}};
972378SN/A
982378SN/A//XXX This trap is apparently dropped from ua2005
992378SN/A/*template<> SparcFaultBase::FaultVals
1002520SN/A    SparcFault<UnimplementedLDD>::vals =
1012520SN/A    {"unimp_ldd", 0x012, 6, {H, H, H}};*/
1022520SN/A
1032521SN/A//XXX This trap is apparently dropped from ua2005
1042520SN/A/*template<> SparcFaultBase::FaultVals
1051885SN/A    SparcFault<UnimplementedSTD>::vals =
1061070SN/A    {"unimp_std", 0x013, 6, {H, H, H}};*/
107954SN/A
1081070SN/Atemplate<> SparcFaultBase::FaultVals
1091070SN/A    SparcFault<FpDisabled>::vals =
1101070SN/A    {"fp_disabled", 0x020, 800, {P, P, H}};
1111070SN/A
1121070SN/Atemplate<> SparcFaultBase::FaultVals
1131070SN/A    SparcFault<FpExceptionIEEE754>::vals =
1141070SN/A    {"fp_exception_ieee_754", 0x021, 1110, {P, P, H}};
1151070SN/A
1161070SN/Atemplate<> SparcFaultBase::FaultVals
1171070SN/A    SparcFault<FpExceptionOther>::vals =
1181070SN/A    {"fp_exception_other", 0x022, 1110, {P, P, H}};
1191070SN/A
1202378SN/Atemplate<> SparcFaultBase::FaultVals
1212378SN/A    SparcFault<TagOverflow>::vals =
1222378SN/A    {"tag_overflow", 0x023, 1400, {P, P, H}};
1232378SN/A
1242378SN/Atemplate<> SparcFaultBase::FaultVals
1252378SN/A    SparcFault<CleanWindow>::vals =
1262378SN/A    {"clean_window", 0x024, 1010, {P, P, H}};
1271885SN/A
1281885SN/Atemplate<> SparcFaultBase::FaultVals
1292901Ssaidi@eecs.umich.edu    SparcFault<DivisionByZero>::vals =
1302901Ssaidi@eecs.umich.edu    {"division_by_zero", 0x028, 1500, {P, P, H}};
1312424SN/A
1321885SN/Atemplate<> SparcFaultBase::FaultVals
1331885SN/A    SparcFault<InternalProcessorError>::vals =
1341885SN/A    {"internal_processor_error", 0x029, 4, {H, H, H}};
1351885SN/A
1361885SN/Atemplate<> SparcFaultBase::FaultVals
1372158SN/A    SparcFault<InstructionInvalidTSBEntry>::vals =
1381885SN/A    {"instruction_invalid_tsb_entry", 0x02A, 210, {H, H, SH}};
1391885SN/A
1401885SN/Atemplate<> SparcFaultBase::FaultVals
1411885SN/A    SparcFault<DataInvalidTSBEntry>::vals =
1421885SN/A    {"data_invalid_tsb_entry", 0x02B, 1203, {H, H, H}};
1431885SN/A
1442989Ssaidi@eecs.umich.edutemplate<> SparcFaultBase::FaultVals
1451885SN/A    SparcFault<DataAccessException>::vals =
1461913SN/A    {"data_access_exception", 0x030, 1201, {H, H, H}};
1471885SN/A
1481885SN/A//XXX This trap is apparently dropped from ua2005
1491885SN/A/*template<> SparcFaultBase::FaultVals
1501885SN/A    SparcFault<DataAccessMMUMiss>::vals =
1511885SN/A    {"data_mmu", 0x031, 12, {H, H, H}};*/
1521885SN/A
1531885SN/Atemplate<> SparcFaultBase::FaultVals
1541885SN/A    SparcFault<DataAccessError>::vals =
1551885SN/A    {"data_access_error", 0x032, 1210, {H, H, H}};
1561885SN/A
1571885SN/Atemplate<> SparcFaultBase::FaultVals
1582989Ssaidi@eecs.umich.edu    SparcFault<DataAccessProtection>::vals =
1591885SN/A    {"data_access_protection", 0x033, 1207, {H, H, H}};
1601885SN/A
1611885SN/Atemplate<> SparcFaultBase::FaultVals
1621885SN/A    SparcFault<MemAddressNotAligned>::vals =
1632378SN/A    {"mem_address_not_aligned", 0x034, 1020, {H, H, H}};
16477SN/A
1652378SN/Atemplate<> SparcFaultBase::FaultVals
1661070SN/A    SparcFault<LDDFMemAddressNotAligned>::vals =
1671070SN/A    {"LDDF_mem_address_not_aligned", 0x035, 1010, {H, H, H}};
1682158SN/A
1692378SN/Atemplate<> SparcFaultBase::FaultVals
1701070SN/A    SparcFault<STDFMemAddressNotAligned>::vals =
1711070SN/A    {"STDF_mem_address_not_aligned", 0x036, 1010, {H, H, H}};
1721070SN/A
1731070SN/Atemplate<> SparcFaultBase::FaultVals
1741070SN/A    SparcFault<PrivilegedAction>::vals =
1752521SN/A    {"privileged_action", 0x037, 1110, {H, H, SH}};
1762902Ssaidi@eecs.umich.edu
1772378SN/Atemplate<> SparcFaultBase::FaultVals
1782378SN/A    SparcFault<LDQFMemAddressNotAligned>::vals =
1791634SN/A    {"LDQF_mem_address_not_aligned", 0x038, 1010, {H, H, H}};
1802567SN/A
1811070SN/Atemplate<> SparcFaultBase::FaultVals
1821070SN/A    SparcFault<STQFMemAddressNotAligned>::vals =
1831070SN/A    {"STQF_mem_address_not_aligned", 0x039, 1010, {H, H, H}};
1842158SN/A
1852378SN/Atemplate<> SparcFaultBase::FaultVals
1862158SN/A    SparcFault<InstructionRealTranslationMiss>::vals =
1871070SN/A    {"instruction_real_translation_miss", 0x03E, 208, {H, H, SH}};
1882158SN/A
1892158SN/Atemplate<> SparcFaultBase::FaultVals
1901070SN/A    SparcFault<DataRealTranslationMiss>::vals =
1912158SN/A    {"data_real_translation_miss", 0x03F, 1203, {H, H, H}};
1921070SN/A
1932SN/A//XXX This trap is apparently dropped from ua2005
1942SN/A/*template<> SparcFaultBase::FaultVals
1951129SN/A    SparcFault<AsyncDataError>::vals =
1961129SN/A    {"async_data", 0x040, 2, {H, H, H}};*/
1972158SN/A
1982158SN/Atemplate<> SparcFaultBase::FaultVals
1991070SN/A    SparcFault<InterruptLevelN>::vals =
2002378SN/A    {"interrupt_level_n", 0x040, 0, {P, P, SH}};
2012378SN/A
2021070SN/Atemplate<> SparcFaultBase::FaultVals
2031070SN/A    SparcFault<HstickMatch>::vals =
2041070SN/A    {"hstick_match", 0x05E, 1601, {H, H, H}};
2051070SN/A
2061070SN/Atemplate<> SparcFaultBase::FaultVals
2071070SN/A    SparcFault<TrapLevelZero>::vals =
2081070SN/A    {"trap_level_zero", 0x05F, 202, {H, H, SH}};
2091070SN/A
2101070SN/Atemplate<> SparcFaultBase::FaultVals
2111070SN/A    SparcFault<InterruptVector>::vals =
2121070SN/A    {"interrupt_vector", 0x060, 2630, {H, H, H}};
2131070SN/A
2141070SN/Atemplate<> SparcFaultBase::FaultVals
2151070SN/A    SparcFault<PAWatchpoint>::vals =
2161070SN/A    {"PA_watchpoint", 0x061, 1209, {H, H, H}};
2171070SN/A
2181070SN/Atemplate<> SparcFaultBase::FaultVals
2191070SN/A    SparcFault<VAWatchpoint>::vals =
2202378SN/A    {"VA_watchpoint", 0x062, 1120, {P, P, SH}};
2212378SN/A
2222378SN/Atemplate<> SparcFaultBase::FaultVals
2232378SN/A    SparcFault<FastInstructionAccessMMUMiss>::vals =
2242378SN/A    {"fast_instruction_access_MMU_miss", 0x064, 208, {H, H, SH}};
2252378SN/A
2262680Sktlim@umich.edutemplate<> SparcFaultBase::FaultVals
2272680Sktlim@umich.edu    SparcFault<FastDataAccessMMUMiss>::vals =
2281070SN/A    {"fast_data_access_MMU_miss", 0x068, 1203, {H, H, H}};
2291070SN/A
2301070SN/Atemplate<> SparcFaultBase::FaultVals
2312SN/A    SparcFault<FastDataAccessProtection>::vals =
23277SN/A    {"fast_data_access_protection", 0x06C, 1207, {H, H, H}};
2332SN/A
2342SN/Atemplate<> SparcFaultBase::FaultVals
2352SN/A    SparcFault<InstructionBreakpoint>::vals =
2362SN/A    {"instruction_break", 0x076, 610, {H, H, H}};
2372SN/A
2382SN/Atemplate<> SparcFaultBase::FaultVals
2392SN/A    SparcFault<CpuMondo>::vals =
2402SN/A    {"cpu_mondo", 0x07C, 1608, {P, P, SH}};
2412SN/A
2422SN/Atemplate<> SparcFaultBase::FaultVals
2432158SN/A    SparcFault<DevMondo>::vals =
2442158SN/A    {"dev_mondo", 0x07D, 1611, {P, P, SH}};
2452SN/A
2462SN/Atemplate<> SparcFaultBase::FaultVals
2472SN/A    SparcFault<ResumableError>::vals =
248    {"resume_error", 0x07E, 3330, {P, P, SH}};
249
250template<> SparcFaultBase::FaultVals
251    SparcFault<SpillNNormal>::vals =
252    {"spill_n_normal", 0x080, 900, {P, P, H}};
253
254template<> SparcFaultBase::FaultVals
255    SparcFault<SpillNOther>::vals =
256    {"spill_n_other", 0x0A0, 900, {P, P, H}};
257
258template<> SparcFaultBase::FaultVals
259    SparcFault<FillNNormal>::vals =
260    {"fill_n_normal", 0x0C0, 900, {P, P, H}};
261
262template<> SparcFaultBase::FaultVals
263    SparcFault<FillNOther>::vals =
264    {"fill_n_other", 0x0E0, 900, {P, P, H}};
265
266template<> SparcFaultBase::FaultVals
267    SparcFault<TrapInstruction>::vals =
268    {"trap_instruction", 0x100, 1602, {P, P, H}};
269
270/**
271 * This causes the thread context to enter RED state. This causes the side
272 * effects which go with entering RED state because of a trap.
273 */
274
275void enterREDState(ThreadContext *tc)
276{
277    //@todo Disable the mmu?
278    //@todo Disable watchpoints?
279    MiscReg HPSTATE = tc->readMiscRegNoEffect(MISCREG_HPSTATE);
280    //HPSTATE.red = 1
281    HPSTATE |= (1 << 5);
282    //HPSTATE.hpriv = 1
283    HPSTATE |= (1 << 2);
284    tc->setMiscReg(MISCREG_HPSTATE, HPSTATE);
285    //PSTATE.priv is set to 1 here. The manual says it should be 0, but
286    //Legion sets it to 1.
287    MiscReg PSTATE = tc->readMiscRegNoEffect(MISCREG_PSTATE);
288    PSTATE |= (1 << 2);
289    tc->setMiscReg(MISCREG_PSTATE, PSTATE);
290}
291
292/**
293 * This sets everything up for a RED state trap except for actually jumping to
294 * the handler.
295 */
296
297void doREDFault(ThreadContext *tc, TrapType tt)
298{
299    MiscReg TL = tc->readMiscRegNoEffect(MISCREG_TL);
300    MiscReg TSTATE = tc->readMiscRegNoEffect(MISCREG_TSTATE);
301    MiscReg PSTATE = tc->readMiscRegNoEffect(MISCREG_PSTATE);
302    MiscReg HPSTATE = tc->readMiscRegNoEffect(MISCREG_HPSTATE);
303    //MiscReg CCR = tc->readMiscRegNoEffect(MISCREG_CCR);
304    MiscReg CCR = tc->readIntReg(NumIntArchRegs + 2);
305    MiscReg ASI = tc->readMiscRegNoEffect(MISCREG_ASI);
306    MiscReg CWP = tc->readMiscRegNoEffect(MISCREG_CWP);
307    //MiscReg CANSAVE = tc->readMiscRegNoEffect(MISCREG_CANSAVE);
308    MiscReg CANSAVE = tc->readMiscRegNoEffect(NumIntArchRegs + 3);
309    MiscReg GL = tc->readMiscRegNoEffect(MISCREG_GL);
310    PCState pc = tc->pcState();
311
312    TL++;
313
314    Addr pcMask = bits(PSTATE, 3) ? mask(32) : mask(64);
315
316    //set TSTATE.gl to gl
317    replaceBits(TSTATE, 42, 40, GL);
318    //set TSTATE.ccr to ccr
319    replaceBits(TSTATE, 39, 32, CCR);
320    //set TSTATE.asi to asi
321    replaceBits(TSTATE, 31, 24, ASI);
322    //set TSTATE.pstate to pstate
323    replaceBits(TSTATE, 20, 8, PSTATE);
324    //set TSTATE.cwp to cwp
325    replaceBits(TSTATE, 4, 0, CWP);
326
327    //Write back TSTATE
328    tc->setMiscRegNoEffect(MISCREG_TSTATE, TSTATE);
329
330    //set TPC to PC
331    tc->setMiscRegNoEffect(MISCREG_TPC, pc.pc() & pcMask);
332    //set TNPC to NPC
333    tc->setMiscRegNoEffect(MISCREG_TNPC, pc.npc() & pcMask);
334
335    //set HTSTATE.hpstate to hpstate
336    tc->setMiscRegNoEffect(MISCREG_HTSTATE, HPSTATE);
337
338    //TT = trap type;
339    tc->setMiscRegNoEffect(MISCREG_TT, tt);
340
341    //Update GL
342    tc->setMiscReg(MISCREG_GL, min<int>(GL+1, MaxGL));
343
344    PSTATE = mbits(PSTATE, 2, 2); // just save the priv bit
345    PSTATE |= (1 << 4); //set PSTATE.pef to 1
346    tc->setMiscRegNoEffect(MISCREG_PSTATE, PSTATE);
347
348    //set HPSTATE.red to 1
349    HPSTATE |= (1 << 5);
350    //set HPSTATE.hpriv to 1
351    HPSTATE |= (1 << 2);
352    //set HPSTATE.ibe to 0
353    HPSTATE &= ~(1 << 10);
354    //set HPSTATE.tlz to 0
355    HPSTATE &= ~(1 << 0);
356    tc->setMiscRegNoEffect(MISCREG_HPSTATE, HPSTATE);
357
358    bool changedCWP = true;
359    if(tt == 0x24)
360        CWP++;
361    else if(0x80 <= tt && tt <= 0xbf)
362        CWP += (CANSAVE + 2);
363    else if(0xc0 <= tt && tt <= 0xff)
364        CWP--;
365    else
366        changedCWP = false;
367
368    if(changedCWP)
369    {
370        CWP = (CWP + NWindows) % NWindows;
371        tc->setMiscReg(MISCREG_CWP, CWP);
372    }
373}
374
375/**
376 * This sets everything up for a normal trap except for actually jumping to
377 * the handler.
378 */
379
380void doNormalFault(ThreadContext *tc, TrapType tt, bool gotoHpriv)
381{
382    MiscReg TL = tc->readMiscRegNoEffect(MISCREG_TL);
383    MiscReg TSTATE = tc->readMiscRegNoEffect(MISCREG_TSTATE);
384    MiscReg PSTATE = tc->readMiscRegNoEffect(MISCREG_PSTATE);
385    MiscReg HPSTATE = tc->readMiscRegNoEffect(MISCREG_HPSTATE);
386    //MiscReg CCR = tc->readMiscRegNoEffect(MISCREG_CCR);
387    MiscReg CCR = tc->readIntReg(NumIntArchRegs + 2);
388    MiscReg ASI = tc->readMiscRegNoEffect(MISCREG_ASI);
389    MiscReg CWP = tc->readMiscRegNoEffect(MISCREG_CWP);
390    //MiscReg CANSAVE = tc->readMiscRegNoEffect(MISCREG_CANSAVE);
391    MiscReg CANSAVE = tc->readIntReg(NumIntArchRegs + 3);
392    MiscReg GL = tc->readMiscRegNoEffect(MISCREG_GL);
393    PCState pc = tc->pcState();
394
395    //Increment the trap level
396    TL++;
397    tc->setMiscRegNoEffect(MISCREG_TL, TL);
398
399    Addr pcMask = bits(PSTATE, 3) ? mask(32) : mask(64);
400
401    //Save off state
402
403    //set TSTATE.gl to gl
404    replaceBits(TSTATE, 42, 40, GL);
405    //set TSTATE.ccr to ccr
406    replaceBits(TSTATE, 39, 32, CCR);
407    //set TSTATE.asi to asi
408    replaceBits(TSTATE, 31, 24, ASI);
409    //set TSTATE.pstate to pstate
410    replaceBits(TSTATE, 20, 8, PSTATE);
411    //set TSTATE.cwp to cwp
412    replaceBits(TSTATE, 4, 0, CWP);
413
414    //Write back TSTATE
415    tc->setMiscRegNoEffect(MISCREG_TSTATE, TSTATE);
416
417    //set TPC to PC
418    tc->setMiscRegNoEffect(MISCREG_TPC, pc.pc() & pcMask);
419    //set TNPC to NPC
420    tc->setMiscRegNoEffect(MISCREG_TNPC, pc.npc() & pcMask);
421
422    //set HTSTATE.hpstate to hpstate
423    tc->setMiscRegNoEffect(MISCREG_HTSTATE, HPSTATE);
424
425    //TT = trap type;
426    tc->setMiscRegNoEffect(MISCREG_TT, tt);
427
428    //Update the global register level
429    if (!gotoHpriv)
430        tc->setMiscReg(MISCREG_GL, min<int>(GL+1, MaxPGL));
431    else
432        tc->setMiscReg(MISCREG_GL, min<int>(GL+1, MaxGL));
433
434    //PSTATE.mm is unchanged
435    PSTATE |= (1 << 4); //PSTATE.pef = whether or not an fpu is present
436    PSTATE &= ~(1 << 3); //PSTATE.am = 0
437    PSTATE &= ~(1 << 1); //PSTATE.ie = 0
438    //PSTATE.tle is unchanged
439    //PSTATE.tct = 0
440
441    if (gotoHpriv)
442    {
443        PSTATE &= ~(1 << 9); // PSTATE.cle = 0
444        //The manual says PSTATE.priv should be 0, but Legion leaves it alone
445        HPSTATE &= ~(1 << 5); //HPSTATE.red = 0
446        HPSTATE |= (1 << 2); //HPSTATE.hpriv = 1
447        HPSTATE &= ~(1 << 10); //HPSTATE.ibe = 0
448        //HPSTATE.tlz is unchanged
449        tc->setMiscRegNoEffect(MISCREG_HPSTATE, HPSTATE);
450    } else { // we are going to priv
451        PSTATE |= (1 << 2); //PSTATE.priv = 1
452        replaceBits(PSTATE, 9, 9, PSTATE >> 8); //PSTATE.cle = PSTATE.tle
453    }
454    tc->setMiscRegNoEffect(MISCREG_PSTATE, PSTATE);
455
456
457    bool changedCWP = true;
458    if (tt == 0x24)
459        CWP++;
460    else if (0x80 <= tt && tt <= 0xbf)
461        CWP += (CANSAVE + 2);
462    else if (0xc0 <= tt && tt <= 0xff)
463        CWP--;
464    else
465        changedCWP = false;
466
467    if (changedCWP)
468    {
469        CWP = (CWP + NWindows) % NWindows;
470        tc->setMiscReg(MISCREG_CWP, CWP);
471    }
472}
473
474void getREDVector(MiscReg TT, Addr &PC, Addr &NPC)
475{
476    //XXX The following constant might belong in a header file.
477    const Addr RSTVAddr = 0xFFF0000000ULL;
478    PC = RSTVAddr | ((TT << 5) & 0xFF);
479    NPC = PC + sizeof(MachInst);
480}
481
482void getHyperVector(ThreadContext * tc, Addr & PC, Addr & NPC, MiscReg TT)
483{
484    Addr HTBA = tc->readMiscRegNoEffect(MISCREG_HTBA);
485    PC = (HTBA & ~mask(14)) | ((TT << 5) & mask(14));
486    NPC = PC + sizeof(MachInst);
487}
488
489void getPrivVector(ThreadContext * tc, Addr & PC, Addr & NPC, MiscReg TT, MiscReg TL)
490{
491    Addr TBA = tc->readMiscRegNoEffect(MISCREG_TBA);
492    PC = (TBA & ~mask(15)) |
493        (TL > 1 ? (1 << 14) : 0) |
494        ((TT << 5) & mask(14));
495    NPC = PC + sizeof(MachInst);
496}
497
498#if FULL_SYSTEM
499
500void SparcFaultBase::invoke(ThreadContext * tc, StaticInstPtr inst)
501{
502    //panic("Invoking a second fault!\n");
503    FaultBase::invoke(tc);
504    countStat()++;
505
506    //We can refer to this to see what the trap level -was-, but something
507    //in the middle could change it in the regfile out from under us.
508    MiscReg tl = tc->readMiscRegNoEffect(MISCREG_TL);
509    MiscReg tt = tc->readMiscRegNoEffect(MISCREG_TT);
510    MiscReg pstate = tc->readMiscRegNoEffect(MISCREG_PSTATE);
511    MiscReg hpstate = tc->readMiscRegNoEffect(MISCREG_HPSTATE);
512
513    Addr PC, NPC;
514
515    PrivilegeLevel current;
516    if (hpstate & HPSTATE::hpriv)
517        current = Hyperprivileged;
518    else if (pstate & PSTATE::priv)
519        current = Privileged;
520    else
521        current = User;
522
523    PrivilegeLevel level = getNextLevel(current);
524
525    if ((hpstate & HPSTATE::red) || (tl == MaxTL - 1)) {
526        getREDVector(5, PC, NPC);
527        doREDFault(tc, tt);
528        //This changes the hpstate and pstate, so we need to make sure we
529        //save the old version on the trap stack in doREDFault.
530        enterREDState(tc);
531    } else if (tl == MaxTL) {
532        panic("Should go to error state here.. crap\n");
533        //Do error_state somehow?
534        //Probably inject a WDR fault using the interrupt mechanism.
535        //What should the PC and NPC be set to?
536    } else if (tl > MaxPTL && level == Privileged) {
537        //guest_watchdog fault
538        doNormalFault(tc, trapType(), true);
539        getHyperVector(tc, PC, NPC, 2);
540    } else if (level == Hyperprivileged ||
541               (level == Privileged && trapType() >= 384)) {
542        doNormalFault(tc, trapType(), true);
543        getHyperVector(tc, PC, NPC, trapType());
544    } else {
545        doNormalFault(tc, trapType(), false);
546        getPrivVector(tc, PC, NPC, trapType(), tl+1);
547    }
548
549    PCState pc;
550    pc.pc(PC);
551    pc.npc(NPC);
552    pc.nnpc(NPC + sizeof(MachInst));
553    pc.upc(0);
554    pc.nupc(1);
555    tc->pcState(pc);
556}
557
558void PowerOnReset::invoke(ThreadContext * tc, StaticInstPtr inst)
559{
560    //For SPARC, when a system is first started, there is a power
561    //on reset Trap which sets the processor into the following state.
562    //Bits that aren't set aren't defined on startup.
563
564    tc->setMiscRegNoEffect(MISCREG_TL, MaxTL);
565    tc->setMiscRegNoEffect(MISCREG_TT, trapType());
566    tc->setMiscReg(MISCREG_GL, MaxGL);
567
568    //Turn on pef and priv, set everything else to 0
569    tc->setMiscRegNoEffect(MISCREG_PSTATE, (1 << 4) | (1 << 2));
570
571    //Turn on red and hpriv, set everything else to 0
572    MiscReg HPSTATE = tc->readMiscRegNoEffect(MISCREG_HPSTATE);
573    //HPSTATE.red = 1
574    HPSTATE |= (1 << 5);
575    //HPSTATE.hpriv = 1
576    HPSTATE |= (1 << 2);
577    //HPSTATE.ibe = 0
578    HPSTATE &= ~(1 << 10);
579    //HPSTATE.tlz = 0
580    HPSTATE &= ~(1 << 0);
581    tc->setMiscRegNoEffect(MISCREG_HPSTATE, HPSTATE);
582
583    //The tick register is unreadable by nonprivileged software
584    tc->setMiscRegNoEffect(MISCREG_TICK, 1ULL << 63);
585
586    //Enter RED state. We do this last so that the actual state preserved in
587    //the trap stack is the state from before this fault.
588    enterREDState(tc);
589
590    Addr PC, NPC;
591    getREDVector(trapType(), PC, NPC);
592
593    PCState pc;
594    pc.pc(PC);
595    pc.npc(NPC);
596    pc.nnpc(NPC + sizeof(MachInst));
597    pc.upc(0);
598    pc.nupc(1);
599    tc->pcState(pc);
600
601    //These registers are specified as "undefined" after a POR, and they
602    //should have reasonable values after the miscregfile is reset
603    /*
604    // Clear all the soft interrupt bits
605    softint = 0;
606    // disable timer compare interrupts, reset tick_cmpr
607    tc->setMiscRegNoEffect(MISCREG_
608    tick_cmprFields.int_dis = 1;
609    tick_cmprFields.tick_cmpr = 0; // Reset to 0 for pretty printing
610    stickFields.npt = 1; //The TICK register is unreadable by by !priv
611    stick_cmprFields.int_dis = 1; // disable timer compare interrupts
612    stick_cmprFields.tick_cmpr = 0; // Reset to 0 for pretty printing
613
614    tt[tl] = _trapType;
615
616    hintp = 0; // no interrupts pending
617    hstick_cmprFields.int_dis = 1; // disable timer compare interrupts
618    hstick_cmprFields.tick_cmpr = 0; // Reset to 0 for pretty printing
619    */
620}
621
622#else // !FULL_SYSTEM
623
624void FastInstructionAccessMMUMiss::invoke(ThreadContext *tc,
625                                          StaticInstPtr inst)
626{
627    Process *p = tc->getProcessPtr();
628    TlbEntry entry;
629    bool success = p->pTable->lookup(vaddr, entry);
630    if(!success) {
631        panic("Tried to execute unmapped address %#x.\n", vaddr);
632    } else {
633        Addr alignedVaddr = p->pTable->pageAlign(vaddr);
634        tc->getITBPtr()->insert(alignedVaddr, 0 /*partition id*/,
635                p->M5_pid /*context id*/, false, entry.pte);
636    }
637}
638
639void FastDataAccessMMUMiss::invoke(ThreadContext *tc, StaticInstPtr inst)
640{
641    Process *p = tc->getProcessPtr();
642    TlbEntry entry;
643    bool success = p->pTable->lookup(vaddr, entry);
644    if(!success) {
645        p->checkAndAllocNextPage(vaddr);
646        success = p->pTable->lookup(vaddr, entry);
647    }
648    if(!success) {
649        panic("Tried to access unmapped address %#x.\n", vaddr);
650    } else {
651        Addr alignedVaddr = p->pTable->pageAlign(vaddr);
652        tc->getDTBPtr()->insert(alignedVaddr, 0 /*partition id*/,
653                p->M5_pid /*context id*/, false, entry.pte);
654    }
655}
656
657void SpillNNormal::invoke(ThreadContext *tc, StaticInstPtr inst)
658{
659    doNormalFault(tc, trapType(), false);
660
661    Process *p = tc->getProcessPtr();
662
663    //XXX This will only work in faults from a SparcLiveProcess
664    SparcLiveProcess *lp = dynamic_cast<SparcLiveProcess *>(p);
665    assert(lp);
666
667    //Then adjust the PC and NPC
668    tc->pcState(lp->readSpillStart());
669}
670
671void FillNNormal::invoke(ThreadContext *tc, StaticInstPtr inst)
672{
673    doNormalFault(tc, trapType(), false);
674
675    Process * p = tc->getProcessPtr();
676
677    //XXX This will only work in faults from a SparcLiveProcess
678    SparcLiveProcess *lp = dynamic_cast<SparcLiveProcess *>(p);
679    assert(lp);
680
681    //Then adjust the PC and NPC
682    tc->pcState(lp->readFillStart());
683}
684
685void TrapInstruction::invoke(ThreadContext *tc, StaticInstPtr inst)
686{
687    //In SE, this mechanism is how the process requests a service from the
688    //operating system. We'll get the process object from the thread context
689    //and let it service the request.
690
691    Process *p = tc->getProcessPtr();
692
693    SparcLiveProcess *lp = dynamic_cast<SparcLiveProcess *>(p);
694    assert(lp);
695
696    lp->handleTrap(_n, tc);
697
698    //We need to explicitly advance the pc, since that's not done for us
699    //on a faulting instruction
700    PCState pc = tc->pcState();
701    pc.advance();
702    tc->pcState(pc);
703}
704
705#endif
706
707} // namespace SparcISA
708
709