Category

Development Platform
Home > SourceCode/Document > Embeded-SCM Develop > VxWorks > View Code
excArchLib.c
Package: vxWorks-source-551.zip　[view]
Upload User: datangss
Upload Date: 2017-07-07
Package Size: 10487k
Code Size: 25k
Category:

VxWorks

Development Platform:

C/C++

excArchLib.c：Code Content
  1. /* excArchLib.c - MIPS architecture exception handling facilities */
  3. /* Copyright 1984-2001 Wind River Systems, Inc. */
  4. #include "copyright_wrs.h"
  6. /*
  7.  * This file has been developed or significantly modified by the
  8.  * MIPS Center of Excellence Dedicated Engineering Staff.
  9.  * This notice is as per the MIPS Center of Excellence Master Partner
  10.  * Agreement, do not remove this notice without checking first with
  11.  * WR/Platforms MIPS Center of Excellence engineering management.
  12.  */
  14. /*
  15. modification history
  16. --------------------
  17. 02h,16jul01,ros  add CofE comment
  18. 02g,13jul01,sru  fix 32-bit extraction of break type
  19. 02f,17apr01,dxc  SPR 64275: Fix to handle MIPS16 correctly
  20. 02h,13apr01,sru  add BSP-callable functions to set exception vectors
  21. 02g,28mar01,sru  use UT_VEC for R3K tlb vector address
  22. 02f,19dec00,pes  Adapt to MIPS32/MIPS64 CPU architectures
  23. 02e,10sep99,myz  added CW4000_16 support
  24. 02d,19jan99,dra  added CW4000, CW4011, VR4100, VR5000 and VR5400 support.
  25. 02c,14oct96,kkk  added R4650 support.
  26. 02c,22jul96,pr   added windview instrumentation.
  27. 02b,30may96,kkk  changed FP exceptions from excIntHandle to excExcHandle.
  28. 02a,18oct93,cd   added R4000 support.
  29. 01z,29sep93,caf  undid fix of SPR #2359.
  30. 01y,07jul93,yao  fixed to preserve parity error bit of status 
  31.  register (SPR #2359).
  32.            +caf  ansification: added cast to cacheInvalidate() parameter,
  33.  added forward declaration of excGetInfoFromESF().
  34. 01x,19oct92,jcf  swapped 5.0/excInfoShow hook order.
  35. 01w,01oct92,ajm  changed excIntToExc to excIntHandle for fpa ints
  36. 01v,31aug92,rrr  fixed code passed to signal handler
  37. 01u,23aug92,jcf  reverted to version 1t.
  38. 01t,23aug92,jcf  changed cache* to CACHE_*.  changed filename.
  39. 01s,07aug92,ajm  ansified
  40. 01r,02aug92,jcf  pass two of exc split. excJobAdd no longer needed.
  41. 01p,30jul92,rrr  pass one of the exc split
  42. 01o,09jul92,ajm  corrected include list with sigLibP.h
  43. 01n,07jul92,ajm  added 5.1 cache support
  44. 01m,04jul92,jcf  scalable/ANSI/cleanup effort.
  45. 01l,06jun92,ajm  5.0.5 merge, notice mod history changes
  46. 01k,26may92,rrr  the tree shuffle
  47. 01j,16jan92,yao  removed EXC_MSG.  made excExcFix() local.  added missing
  48.                  args to excJobAdd() and printExc(). added excFaultTab[].
  49.                  moved excDeliverSignal() to src/all/excLib.c.
  50. 02i,16jan92,jdi  made excExcFix() NOMANUAL.
  51. 02h,14jan92,jdi  documentation cleanup.
  52. 01g,18nov91,ajm  turned off rom based vectors in excVecInit
  53. 01f,05oct91,ajm  corrected order of VME interrupts in excMsgs
  54. 01e,04oct91,rrr  passed through the ansification filter
  55.                   -changed includes to have absolute path from h/
  56.                   -changed VOID to void
  57.                   -changed copyright notice
  58. 01d,31jul91,ajm  made co-processor exceptions place fpcsr in sigcontext
  59.   made excExcFix global for handling of fpa interrupts
  60.   this should be changed later
  61. 01c,17jul91,ajm  added interrupt ack to excIntHandle
  62. 01b,01jul91,ajm  fixed badva not to be valid on bus error
  63. 01a,01apr91,ajm  MIPS-ized and split from excLib.c.  Derived from 02h of 68k.
  64. */
  66. /*
  67. This module provides architecture-dependent facilities for handling MIPS
  68. R-Series exceptions.  See excLib for the portions that are architecture
  69. independent.
  71. INITIALIZATION
  72. Initialization of exception handling facilities is in two parts.  First,
  73. excVecInit() is called to set all the MIPS exception, trap, and interrupt
  74. vectors to the default handlers provided by this module.  The rest of this
  75. package is initialized by calling excInit() (in excLib), which spawns the
  76. exception support task, excTask(), and creates the pipe used to communicate
  77. with it.  See the manual entry for excLib for more information.
  79. SEE ALSO: excLib,
  80. .pG "Debugging"
  81. */
  83. /* LINTLIBRARY */
  85. #include "vxWorks.h"
  86. #include "esf.h"
  87. #include "iv.h"
  88. #include "sysLib.h"
  89. #include "intLib.h"
  90. #include "msgQLib.h"
  91. #include "signal.h"
  92. #include "cacheLib.h"
  93. #include "errnoLib.h"
  94. #include "dsmLib.h"
  95. #include "private/funcBindP.h"
  96. #include "private/sigLibP.h"
  97. #include "private/taskLibP.h"
  98. #include "string.h"
  99. #include "rebootLib.h"
  102. /* externals  */
  104. IMPORT void excIntToExc ();     /* change interrupt thread */
  105. IMPORT FUNCPTR excExcepHook;    /* add'l rtn to call when exceptions occur */
  106. IMPORT int sysAutoAck(int );
  107. IMPORT ULONG sysBusEar(void );
  108. IMPORT USHORT sysBusEid(void );
  110. /* forward declarations */
  112. LOCAL void excIntHandle (int vecNum, ESFMIPS * pEsf);
  113. void     excExcHandle (int vecNum, ESFMIPS * pEsf, REG_SET * pRegs);
  114. LOCAL int  excGetInfoFromESF (FAST int vecNum, FAST ESFMIPS *pEsf,
  115.       EXC_INFO *pExcInfo);
  117. /*
  118. * excBsrTbl - table of BSRs
  119. *
  120. * The BSR table is the pointer table for MIPS specific 
  121. * exceptions, and interrupts.  After an exception, the least 
  122. * significant bits of the cause register will point us here.  
  123. * After an interrupt, we use the structure intPrioTbl to point 
  124. * us to the correct entry.
  125. */
  127. VOIDFUNCPTR excBsrTbl[] = 
  128.     {
  129.     excIntHandle,  /* 0 - interrupt exception */
  130.     excExcHandle,  /* 1 - tlb mod exception */
  131.     excExcHandle,  /* 2 - tlb load exception */
  132.     excExcHandle, /* 3 - tlb store exception */
  133.     excExcHandle,  /* 4 - address load exception */
  134.     excExcHandle,  /* 5 - address store exception */
  135.     excExcHandle,  /* 6 - instr. bus error exception*/
  136.     excExcHandle, /* 7 - data bus error exception */
  137.     excExcHandle,  /* 8 - system call exception */
  138.     excExcHandle,  /* 9 - break point exception */
  139.     excExcHandle,  /* 10 - rsvd instruction exception*/
  140.     excExcHandle, /* 11 - coprocessor unusable excptn*/
  141.     excExcHandle,  /* 12 - overflow exception */
  142.     excExcHandle, /* 13 - trap exception  */
  143.     excExcHandle,  /* 14 - VCEI exception  */
  144.     excExcHandle, /* 15 - FPE exception  */
  145.     excExcHandle, /* 16 - reserved entry */
  146.     excExcHandle, /* 17 - reserved entry */
  147.     excExcHandle, /* 18 - reserved entry */
  148.     excExcHandle, /* 19 - reserved entry */
  149.     excExcHandle, /* 20 - reserved entry */
  150.     excExcHandle, /* 21 - reserved entry */
  151.     excExcHandle, /* 22 - reserved entry */
  152.     excExcHandle, /* 23 - watch exception */
  153.     excExcHandle, /* 24 - reserved entry */
  154.     excExcHandle, /* 25 - reserved entry */
  155.     excExcHandle, /* 26 - reserved entry */
  156.     excExcHandle, /* 27 - reserved entry */
  157.     excExcHandle, /* 28 - reserved entry */
  158.     excExcHandle, /* 29 - reserved entry */
  159.     excExcHandle, /* 30 - reserved entry */
  160.     excExcHandle, /* 31 - VCED exception */
  161.     excIntHandle, /* 32 - software trap 0  */
  162.     excIntHandle, /* 33 - software trap 1  */
  163.     excIntHandle, /* 34 - autovec VME irq7 interrupt  */
  164.     excIntHandle, /* 35 - autovec VME irq6 interrupt  */
  165.     excIntHandle, /* 36 - autovec VME irq5 interrupt  */
  166.     excIntHandle, /* 37 - autovec VME irq4 interrupt  */
  167.     excIntHandle, /* 38 - autovec VME irq3 interrupt */
  168.     excIntHandle, /* 39 - autovec VME irq2 interrupt */
  169.     excIntHandle, /* 40 - autovec VME irq1 interrupt  */
  170.     excIntHandle, /* 41 - spare interrupt */
  171.     excIntHandle, /* 42 - uart 0 interrupt */
  172.     excIntHandle, /* 43 - uart 1 interrupt */
  173.     excIntHandle, /* 44 - msg pending interrupt */
  174.     excIntHandle, /* 45 - spare interrupt */
  175.     excIntHandle, /* 46 - spare interrupt */
  176.     excIntHandle, /* 47 - hw bp interrupt */
  177.     excIntHandle, /* 48 - spare interrupt */
  178.     excIntHandle, /* 49 - spare interrupt */
  179.     excIntHandle, /* 50 - timer 0 interrupt */
  180.     excIntHandle, /* 51 - timer 1 interrupt */
  181.     excIntHandle, /* 52 - spare exception */
  182.     excIntHandle, /* 53 - spare exception */
  183.     excExcHandle, /* 54 - unimplemented FPA oper */
  184.     excExcHandle, /* 55 - invalid FPA operation */
  185.     excExcHandle, /* 56 - FPA div by zero */
  186.     excExcHandle, /* 57 - FPA overflow exception */
  187.     excExcHandle, /* 58 - FPA underflow exception */
  188.     excExcHandle, /* 59 - FPA inexact operation */
  189.     excIntHandle, /* 60 - bus error interrupt */
  190.     excIntHandle,
  191.     excIntHandle,
  192.     excIntHandle,
  193.     excIntHandle,
  194.     excIntHandle,
  195.     excIntHandle,
  196.     excIntHandle,
  197.     excIntHandle,
  198.     excIntHandle,
  199.     excIntHandle, /* 70 */
  200.     excIntHandle,
  201.     excIntHandle,
  202.     excIntHandle,
  203.     excIntHandle,
  204.     excIntHandle,
  205.     excIntHandle,
  206.     excIntHandle,
  207.     excIntHandle,
  208.     excIntHandle,
  209.     excIntHandle, /* 80 */
  210.     excIntHandle,
  211.     excIntHandle,
  212.     excIntHandle,
  213.     excIntHandle,
  214.     excIntHandle,
  215.     excIntHandle,
  216.     excIntHandle,
  217.     excIntHandle,
  218.     excIntHandle,
  219.     excIntHandle, /* 90 */
  220.     excIntHandle,
  221.     excIntHandle,
  222.     excIntHandle,
  223.     excIntHandle,
  224.     excIntHandle,
  225.     excIntHandle,
  226.     excIntHandle,
  227.     excIntHandle,
  228.     excIntHandle,
  229.     excIntHandle, /* 100 */
  230.     excIntHandle,
  231.     excIntHandle,
  232.     excIntHandle,
  233.     excIntHandle,
  234.     excIntHandle,
  235.     excIntHandle,
  236.     excIntHandle,
  237.     excIntHandle,
  238.     excIntHandle,
  239.     excIntHandle, /* 110 */
  240.     excIntHandle,
  241.     excIntHandle,
  242.     excIntHandle,
  243.     excIntHandle,
  244.     excIntHandle,
  245.     excIntHandle,
  246.     excIntHandle,
  247.     excIntHandle,
  248.     excIntHandle,
  249.     excIntHandle, /* 120 */
  250.     excIntHandle,
  251.     excIntHandle,
  252.     excIntHandle,
  253.     excIntHandle,
  254.     excIntHandle,
  255.     excIntHandle,
  256.     excIntHandle,
  257.     excIntHandle,
  258.     excIntHandle,
  259.     excIntHandle, /* 130 */
  260.     excIntHandle,
  261.     excIntHandle,
  262.     excIntHandle,
  263.     excIntHandle,
  264.     excIntHandle,
  265.     excIntHandle,
  266.     excIntHandle,
  267.     excIntHandle,
  268.     excIntHandle,
  269.     excIntHandle, /* 140 */
  270.     excIntHandle,
  271.     excIntHandle,
  272.     excIntHandle,
  273.     excIntHandle,
  274.     excIntHandle,
  275.     excIntHandle,
  276.     excIntHandle,
  277.     excIntHandle,
  278.     excIntHandle,
  279.     excIntHandle, /* 150 */
  280.     excIntHandle,
  281.     excIntHandle,
  282.     excIntHandle,
  283.     excIntHandle,
  284.     excIntHandle,
  285.     excIntHandle,
  286.     excIntHandle,
  287.     excIntHandle,
  288.     excIntHandle,
  289.     excIntHandle, /* 160 */
  290.     excIntHandle,
  291.     excIntHandle,
  292.     excIntHandle,
  293.     excIntHandle,
  294.     excIntHandle,
  295.     excIntHandle,
  296.     excIntHandle,
  297.     excIntHandle,
  298.     excIntHandle,
  299.     excIntHandle, /* 170 */
  300.     excIntHandle,
  301.     excIntHandle,
  302.     excIntHandle,
  303.     excIntHandle,
  304.     excIntHandle,
  305.     excIntHandle,
  306.     excIntHandle,
  307.     excIntHandle,
  308.     excIntHandle,
  309.     excIntHandle, /* 180 */
  310.     excIntHandle,
  311.     excIntHandle,
  312.     excIntHandle,
  313.     excIntHandle,
  314.     excIntHandle,
  315.     excIntHandle,
  316.     excIntHandle,
  317.     excIntHandle,
  318.     excIntHandle,
  319.     excIntHandle, /* 190 */
  320.     excIntHandle,
  321.     excIntHandle,
  322.     excIntHandle,
  323.     excIntHandle,
  324.     excIntHandle,
  325.     excIntHandle,
  326.     excIntHandle,
  327.     excIntHandle,
  328.     excIntHandle,
  329.     excIntHandle, /* 200 */
  330.     excIntHandle,
  331.     excIntHandle,
  332.     excIntHandle,
  333.     excIntHandle,
  334.     excIntHandle,
  335.     excIntHandle,
  336.     excIntHandle,
  337.     excIntHandle,
  338.     excIntHandle,
  339.     excIntHandle, /* 210 */
  340.     excIntHandle,
  341.     excIntHandle,
  342.     excIntHandle,
  343.     excIntHandle,
  344.     excIntHandle,
  345.     excIntHandle,
  346.     excIntHandle,
  347.     excIntHandle,
  348.     excIntHandle,
  349.     excIntHandle, /* 220 */
  350.     excIntHandle,
  351.     excIntHandle,
  352.     excIntHandle,
  353.     excIntHandle,
  354.     excIntHandle,
  355.     excIntHandle,
  356.     excIntHandle,
  357.     excIntHandle,
  358.     excIntHandle,
  359.     excIntHandle, /* 230 */
  360.     excIntHandle,
  361.     excIntHandle,
  362.     excIntHandle,
  363.     excIntHandle,
  364.     excIntHandle,
  365.     excIntHandle,
  366.     excIntHandle,
  367.     excIntHandle,
  368.     excIntHandle,
  369.     excIntHandle, /* 240 */
  370.     excIntHandle,
  371.     excIntHandle,
  372.     excIntHandle,
  373.     excIntHandle,
  374.     excIntHandle,
  375.     excIntHandle,
  376.     excIntHandle,
  377.     excIntHandle,
  378.     excIntHandle,
  379.     excIntHandle, /* 250 */
  380.     excIntHandle,
  381.     excIntHandle,
  382.     excIntHandle,
  383.     excIntHandle,
  384.     excIntHandle, /* 255 */
  385.     };
  387. /*
  388. * sysExcVecInitHook - Initialized to NULL, but can be modified by a BSP 
  389. * prior to the call to excVecInit() to provide an alternate means of 
  390. * initializing the exception vectors.  This variable is placed in the
  391. * data segment rather than the BSS, because the BSP hook that is used
  392. * to set this variable is called before the BSS is cleared.
  393. */
  395. FUNCPTR sysExcVecInitHook = NULL;
  398. /*******************************************************************************
  399. *
  400. * excNormVecInit - initialize the normal exception vector.
  401. *
  402. * This routine loads the exception handler code for the normal exception 
  403. * vector into the address requested by the BSP.
  404. *
  405. * RETURNS: N/A
  406. */
  408. void excNormVecInit
  409.     (
  410.     void *vecAdrs
  411.     )
  412.     {
  413.     extern int excNormVec[]; /* instructions for branch to normal handler */
  414.     extern int excNormVecSize;
  416.     /* Load normal exception vector and invalidate instruction cache */
  417.     
  418.     bcopy ((const char *) excNormVec, (char *) vecAdrs, excNormVecSize);
  419.     cacheTextUpdate (vecAdrs, excNormVecSize);
  420.     }
  423. /*******************************************************************************
  424. *
  425. * excTlbVecInit - initialize the TLB exception vector.
  426. *
  427. * This routine loads the exception handler code for the TLB exception 
  428. * vector into the address requested by the BSP.
  429. *
  430. * RETURNS: N/A
  431. */
  433. void excTlbVecInit
  434.     (
  435.     void *vecAdrs
  436.     )
  437.     {
  438.     extern int excTlbVec[]; /* instructions for branch to TLB handler */
  439.     extern int excTlbVecSize;
  441.     /* Load tlb vector and invalidate instruction cache */
  443.     bcopy ((const char *) excTlbVec, (char *) vecAdrs, excTlbVecSize);
  444.     cacheTextUpdate (vecAdrs, excTlbVecSize);
  445.     }
  448. #ifndef _WRS_R3K_EXC_SUPPORT
  450. /*******************************************************************************
  451. *
  452. * excXtlbVecInit - initialize the XTLB exception vector.
  453. *
  454. * This routine loads the exception handler code for the XTLB exception 
  455. * vector into the address requested by the BSP.
  456. *
  457. * RETURNS: N/A
  458. */
  460. void excXtlbVecInit
  461.     (
  462.     void *vecAdrs
  463.     )
  464.     {
  465.     extern int excXtlbVec[]; /* instructions for branch to xtlb handler */
  466.     extern int excXtlbVecSize;
  468.     /* Load xtlb vector and invalidate instruction cache */
  470.     bcopy ((const char *) excXtlbVec, (char *) vecAdrs, excXtlbVecSize);
  471.     cacheTextUpdate (vecAdrs, excXtlbVecSize);
  472.     }
  474. /*******************************************************************************
  475. *
  476. * excCacheVecInit - initialize the cache exception vector.
  477. *
  478. * This routine loads the exception handler code for the cache exception 
  479. * vector into the address requested by the BSP.
  480. *
  481. * RETURNS: N/A
  482. */
  484. void excCacheVecInit
  485.     (
  486.     void *vecAdrs
  487.     )
  488.     {
  489.     extern int excCacheVec[]; /* instructions for branch to cache handler */
  490.     extern int excCacheVecSize;
  492.     /* Load cache exception vector and invalidate instruction cache */
  494.     bcopy ((const char *) excCacheVec, (char *) vecAdrs, excCacheVecSize);
  495.     cacheTextUpdate (vecAdrs, excCacheVecSize);
  496.     }
  498. #endif /* _WRS_R3K_EXC_SUPPORT */
  500. /*******************************************************************************
  502. *
  503. * excVecInit - initialize the exception/interrupt vectors
  504. *
  505. * This routine sets up the MIPS exception vectors to point to the 
  506. * appropriate default exception handlers.
  507. *
  508. * INTERNAL
  509. * The common exception handler excStub() is found in excALib.s.
  510. * 
  511. * WHEN TO CALL
  512. * This routine is usually called from the system start-up routine
  513. * usrInit() in usrConfig.c, before interrupts are enabled.
  514. *
  515. * RETURNS: OK (always).
  516. *
  517. * SEE ALSO: excLib
  518. */
  520. STATUS excVecInit (void)
  521.     {
  522.     extern int excNormVec[]; /* instructions for branch to normal handler */
  523.     extern int excNormVecSize;
  524.     extern int excTlbVec[]; /* instructions for branch to tlb handler */
  525.     extern int excTlbVecSize; /* instructions for branch to tlb handler */
  526. #ifndef _WRS_R3K_EXC_SUPPORT
  527.     extern int excXtlbVec[]; /* instructions for branch to xtlb handler */
  528.     extern int excXtlbVecSize; /* instructions for branch to xtlb handler */
  529.     extern int excCacheVec[]; /* instructions for branch to cache handler */
  530.     extern int excCacheVecSize; /* instructions for branch to cache handler */
  531. #endif /* _WRS_R3K_EXC_SUPPORT */
  532.     ULONG srValue; /* status register placeholder */
  534.     /* If available, use BSP-provided initialization function */
  536.     if (sysExcVecInitHook != NULL)
  537. {
  538. (*sysExcVecInitHook)();
  539. }
  540.     else
  541. {
  542. /* Load normal vector and invalidate instruction cache */
  543. bcopy ((const char *)excNormVec, (char *) E_VEC, excNormVecSize);
  544. cacheTextUpdate ((void *) E_VEC, excNormVecSize);
  546.     /* Load tlb vector and invalidate instruction cache */
  547. #ifdef _WRS_R3K_EXC_SUPPORT
  548. bcopy ((const char *)excTlbVec, (char *) UT_VEC, excTlbVecSize);
  549. cacheTextUpdate ((void *) UT_VEC, excTlbVecSize);
  550. #else /* !_WRS_R3K_EXC_SUPPORT */
  551. bcopy ((const char *)excTlbVec, (char *) T_VEC, excTlbVecSize);
  552. cacheTextUpdate ((void *) T_VEC, excTlbVecSize);
  553. #endif /* !_WRS_R3K_EXC_SUPPORT */
  555. #ifndef _WRS_R3K_EXC_SUPPORT
  556. /* Load xtlb vector and invalidate instruction cache */
  557. bcopy ((const char *)excXtlbVec, (char *) X_VEC, excXtlbVecSize);
  558. cacheTextUpdate ((void *) X_VEC, excXtlbVecSize);
  559. /* Load cache exception vector and invalidate instruction cache */
  560. bcopy ((const char *)excCacheVec, (char *) C_VEC, excCacheVecSize);
  561. cacheTextUpdate ((void *) C_VEC, excCacheVecSize);
  562. #endif /* _WRS_R3K_EXC_SUPPORT */
  563. }
  565.     /* Make the vectors usable by turning off rom based vectors */
  567.     srValue = intSRGet();
  568.     srValue &= ~SR_BEV;
  569.     intSRSet(srValue);
  571.     return (OK);
  572.     }
  573. /*******************************************************************************
  574. *
  575. * excExcHandle - interrupt level handling of exceptions
  576. *
  577. * This routine handles exception traps. It is never be called except 
  578. * from the special assembly language interrupt stub routine.
  579. *
  580. * It prints out a bunch of pertinent information about the trap that
  581. * occurred via excTask.
  582. *
  583. * Note that this routine runs in the context of the task that got the exception.
  584. *
  585. * NOMANUAL
  586. */
  588. void excExcHandle
  589.     (
  590.     int vecNum, /* exception vector number */
  591.     ESFMIPS * pEsf, /* pointer to exception stack frame */
  592.     REG_SET * pRegs  /* pointer to general regs on esf */
  593.     )
  594.     {
  595.     EXC_INFO excInfo;
  596.     int esfSize;
  598. #ifdef _WRS_R3K_EXC_SUPPORT
  599.     /* restore old sr so it looks like an rfe occured thus allowing interrupts*/ 
  600.     pEsf->esfRegs.sr = (pEsf->esfRegs.sr & ~(SR_KUP|SR_IEP|SR_KUC|SR_IEC)) |
  601.        ((pEsf->esfRegs.sr & 
  602. (SR_KUO|SR_IEO|SR_KUP|SR_IEP|SR_KUC|SR_IEC)) >> 2);
  603. #else
  604.     /* restore old sr so it looks like an eret occured */ 
  605.     pEsf->esfRegs.sr &= ~SR_EXL;
  606. #endif
  608.     esfSize = excGetInfoFromESF (vecNum, pEsf, &excInfo);
  610.     /* fix task stack pointer and registers */
  612.     pRegs->sr    = pEsf->esfRegs.sr;
  614.     if ((_func_excBaseHook != NULL) && /* user hook around? */
  615. ((* _func_excBaseHook) (vecNum, pEsf, pRegs, &excInfo)))
  616. return; /* user hook fixed it */
  618. #ifdef WV_INSTRUMENTATION
  619.     /* windview - level 3 event logging */
  620.     EVT_CTX_1(EVENT_EXCEPTION, vecNum);
  621. #endif /* WV_INSTRUMENTATION */
  623.     if (INT_CONTEXT ())
  624. {
  625. if (_func_excPanicHook != NULL) /* panic hook? */
  626.     (*_func_excPanicHook) (vecNum, pEsf, pRegs, &excInfo);
  628. reboot (BOOT_WARM_AUTOBOOT);
  629. return; /* reboot returns?! */
  630. }
  632.     /* task caused exception */
  634.     taskIdCurrent->pExcRegSet = pRegs; /* for taskRegs[GS]et */
  636.     taskIdDefault ((int)taskIdCurrent); /* update default tid */
  638.     bcopy ((char *) &excInfo, (char *) &(taskIdCurrent->excInfo),
  639.    sizeof (EXC_INFO)); /* copy in exc info */
  641.     if (_func_sigExcKill != NULL)
  642. _func_sigExcKill((int) vecNum, vecNum, pRegs);
  644.     if (_func_excInfoShow != NULL) /* default show rtn? */
  645. (*_func_excInfoShow) (&excInfo, TRUE);
  647.     if (excExcepHook != NULL)
  648. (* excExcepHook) (taskIdCurrent, vecNum, pEsf);
  650.     taskSuspend (0); /* whoa partner... */
  652.     taskIdCurrent->pExcRegSet = (REG_SET *) NULL; /* invalid after rts */
  653.     }
  655. /*****************************************************************************
  656. *
  657. * excBreakTypeGet - Get break type number from break instruction.
  658. *
  659. * RETURNS: break instruction type
  660. */
  661. uint16_t excBreakTypeGet
  662.     (
  663.     ESFMIPS *pEsf /* pointer to Exception Stack Frame */
  664.     )
  665.     {
  666.     uint32_t epc;       /* Exception Program Counter Register */
  667.     uint32_t *pInst32;  /* epc typed as a pointer to a 32-bit instruction */
  668. #ifdef _WRS_MIPS16
  669.     uint16_t *pInst16;  /* epc typed as a pointer to a 16-bit instruction */
  670. #endif
  671.     uint16_t breakType; /* returned break type */
  672.     
  673.     epc = (uint32_t) pEsf->esfRegs.pc;
  675.     /*
  676.      * Determine type of BREAK exception by examining the BREAK instruction.
  677.      * If the breaked instruction is a branch delay slot, then the pc is the
  678.      * address of the preceding jump or branch instruction. In this case, the
  679.      * instruction at pc + 1 must be examined.
  680.      *
  681.      * For MIPS16 CPU, check the EPC for 16-bit ISA Mode, and retrieve the
  682.      * break exception type from the 16-bit break instruction. In this case,
  683.      * there is no branch delay slot.
  684.      */
  686. #ifdef _WRS_MIPS16
  688.     /* If executing in 16-bit instruction mode then decode 16-bit break
  689.      * instruction. Else decode 32-bit break instruction.
  690.      */
  691.     if (epc & EPC_EIM)
  692. {
  693. /* Executing in 16-bit instruction mode on a MIPS16.
  694.  * There is no branch delay slot in 16-bit ISA mode.
  695.  */
  696. pInst16 = (uint16_t *) (epc & EPC_PC);
  697. breakType = (*pInst16 & BREAK16_CODE_MASK) >> BREAK16_CODE_POS;
  698. }
  699.     else 
  700. { /* Executing in 32-bit instruction mode on a MIPS16*/
  701. pInst32 = (uint32_t *) epc;
  702. if (pEsf->cause & CAUSE_BD) /* Branch Delay Slot */
  703.     pInst32++;
  705. breakType = (uint16_t) ((*pInst32 & BREAK_CODE_MASK) >> BREAK_CODE_POS);
  706. }
  707.     
  708. #else /* !_WRS_MIPS16 */
  709.     
  710.     pInst32 = (uint32_t *) epc;
  711.     if (pEsf->cause & CAUSE_BD) /* Branch Delay Slot */
  712. pInst32++;
  713.     
  714.     breakType = (uint16_t) ((*pInst32 & BREAK_CODE_MASK) >> BREAK_CODE_POS);
  715.     
  716. #endif /* _WRS_MIPS16 */
  718.     return (breakType);
  719.     }
  721. /*******************************************************************************
  722. *
  723. * excIntHandle - interrupt level handling of interrupts
  724. *
  725. * This routine handles interrupts. It is never be called except 
  726. * from the special assembly language interrupt stub routine.
  727. *
  728. * It prints out a bunch of pertinent information about the trap that
  729. * occurred via excTask.
  730. */
  732. LOCAL void excIntHandle
  733.     (
  734.     int vecNum, /* exception vector number */
  735.     ESFMIPS * pEsf  /* pointer to exception stack frame */
  736.     )
  737.     {
  738.     USHORT eid = 0; /* clear data bus interrupt */
  739.     int result; /* unacked ints return value */
  741. #ifdef WV_INSTRUMENTATION
  743.     /* windview - level 3 event logging */
  744.     EVT_CTX_1(EVENT_EXCEPTION, vecNum);
  746. #endif /* WV_INSTRUMENTATION */
  748.     if ((vecNum <= HIGH_VEC) && (vecNum >= LOW_VEC))
  749. {
  750. result = sysAutoAck(vecNum); /* clear interrupt condition */
  752.         if (vecNum == IV_BUS_ERROR_VEC)
  753.     eid = (USHORT) result; /* result of data bus interrupt */
  754.     
  755.         if ((vecNum <= IV_FPA_PREC_VEC) && (vecNum >= IV_FPA_UNIMP_VEC))
  756.             pEsf->fpcsr = result; /* result of fpa interrupt */
  757. }
  759.     if (_func_excIntHook != NULL)
  760. (*_func_excIntHook) (vecNum, pEsf, eid);
  761.     }
  762. /*****************************************************************************
  763. *
  764. * excGetInfoFromESF - get relevent info from exception stack frame
  765. *
  766. * RETURNS: size of specified ESF
  767. */
  769. LOCAL int excGetInfoFromESF
  770.     (
  771.     FAST int vecNum,
  772.     FAST ESFMIPS *pEsf,
  773.     EXC_INFO *pExcInfo 
  774.     )
  775.     {
  776.     pExcInfo->vecNum = vecNum;
  777.     pExcInfo->valid  = EXC_VEC_NUM;
  779.     if (( vecNum == IV_TLBMOD_VEC ) || (vecNum == IV_TLBL_VEC ) ||
  780.         (vecNum == IV_TLBS_VEC ) || (vecNum == IV_ADEL_VEC ) ||
  781.         (vecNum == IV_ADES_VEC ))
  782.         {
  783. /* Its an address error , or tlb miss */
  785. pExcInfo->valid     |= EXC_EPC | EXC_STATUS_REG | EXC_ACCESS_ADDR |
  786.        EXC_CAUSE_REG ;
  787. pExcInfo->epc        = ((ESFMIPS *)pEsf)->esfRegs.pc;
  788. pExcInfo->statusReg  = ((ESFMIPS *)pEsf)->esfRegs.sr;
  789. pExcInfo->causeReg   = ((ESFMIPS *)pEsf)->cause;
  790. pExcInfo->badVa      = ((ESFMIPS *)pEsf)->badva;
  792. return (sizeof (ESFMIPS));
  793. }
  794.     else if ( (vecNum == IV_IBUS_VEC ) || (vecNum == IV_DBUS_VEC ))
  795.         {
  796. /* Its a bus error */
  798. pExcInfo->valid     |= EXC_EPC | EXC_STATUS_REG | 
  799.        EXC_CAUSE_REG | EXC_ERROR_ADDR ;
  801. pExcInfo->epc        = ((ESFMIPS *)pEsf)->esfRegs.pc;
  802. pExcInfo->statusReg  = ((ESFMIPS *)pEsf)->esfRegs.sr;
  803. pExcInfo->causeReg   = ((ESFMIPS *)pEsf)->cause;
  804. pExcInfo->ear        = sysBusEar();
  805. pExcInfo->eid        = sysBusEid();
  807. return (sizeof (ESFMIPS));
  808. }
  809.     else if ((vecNum <= IV_FPA_PREC_VEC) && (vecNum >= IV_FPA_UNIMP_VEC))
  810.         {
  811. /* Its a floating point error */
  813. pExcInfo->valid     |= EXC_EPC | EXC_STATUS_REG |
  814.        EXC_CAUSE_REG | EXC_FP_STATUS_REG ;
  815. pExcInfo->epc        = ((ESFMIPS *)pEsf)->esfRegs.pc;
  816. pExcInfo->statusReg  = ((ESFMIPS *)pEsf)->esfRegs.sr;
  817. pExcInfo->causeReg   = ((ESFMIPS *)pEsf)->cause;
  818. pExcInfo->fpcsr      = ((ESFMIPS *)pEsf)->fpcsr;
  820. return (sizeof (ESFMIPS));
  821. }
  822. #ifdef EXC_BREAK_TYPE    
  823.     else if (vecNum == IV_BP_VEC)
  824. {
  825. pExcInfo->valid    |= EXC_EPC | EXC_STATUS_REG | EXC_CAUSE_REG
  826.                       | EXC_BREAK_TYPE;
  827. pExcInfo->epc       = ((ESFMIPS *)pEsf)->esfRegs.pc;
  828. pExcInfo->statusReg = ((ESFMIPS *)pEsf)->esfRegs.sr;
  829. pExcInfo->causeReg  = ((ESFMIPS *)pEsf)->cause;
  830. pExcInfo->breakType = excBreakTypeGet(pEsf);
  832. return (sizeof (ESFMIPS));
  833. }
  834. #endif
  835.     else
  836. {
  837. pExcInfo->valid    |= EXC_EPC | EXC_STATUS_REG | EXC_CAUSE_REG;
  838. pExcInfo->epc       = ((ESFMIPS *)pEsf)->esfRegs.pc;
  839. pExcInfo->statusReg = ((ESFMIPS *)pEsf)->esfRegs.sr;
  840. pExcInfo->causeReg  = ((ESFMIPS *)pEsf)->cause;
  842. return (sizeof (ESFMIPS));
  843. }
  844.     }
  846. #if 0
  847. /*******************************************************************************
  848. *
  849. * programError - determine if exception is program error
  850. *
  851. * RETURNS:
  852. *   TRUE if exception indicates program error,
  853. *   FALSE if hardware interrupt or failure.
  854. */
  856. LOCAL BOOL programError
  857.     (
  858.     int vecNum  /* exception vector number */
  859.     )
  860.     {
  861.     return (((vecNum < USER_VEC_START) && 
  862.             ((vecNum != IV_SYSCALL_VEC) && (vecNum != IV_BP_VEC))) || 
  863.              (vecNum == IV_BUS_ERROR_VEC) ); 
  864.     }
  865. #endif