Kernel/arch/x86/kpanic.c

   1 /*
   2  * Acess 2 Kernel
   3  * - By John Hodge (thePowersGang)
   4  *
   5  * kpanic.c
   6  * - x86 Kernel Panic Handler
   7  */
   8
   9 #include <acess.h>
  10 #include <proc.h>
  11
  12 // === CONSTANTS ===
  13 #define FB      ((Uint16 *)(KERNEL_BASE|0xB8000))
  14 #define BGC     0x4F00  // White on Red
  15 //#define BGC   0xC000  // Black on Bright Red
  16 //#define BGC   0x1F00  // White on Blue (BSOD!)
  17
  18 // === IMPORTS ===
  19 extern Uint32   GetEIP(void);
  20 extern void     Error_Backtrace(Uint32 eip, Uint32 ebp);
  21 #if USE_MP
  22 extern void     MP_SendIPIVector(int CPU, Uint8 Vector);
  23 extern int      giNumCPUs;
  24 extern int      GetCPUNum(void);
  25 #endif
  26
  27 // === PROTOTYPES ===
  28 void    KernelPanic_SetMode(void);
  29 void    KernelPanic_PutChar(char Ch);
  30
  31 // === CONSTANTS ===
  32 const struct {
  33         Uint16  IdxPort;
  34         Uint16  DatPort;
  35         Uint8   Index;
  36         Uint8   Value;
  37 }       caRegValues[] = {
  38         //{0x3C0, 0x3C0, 0x10, 0x0C},   // Mode Control (Blink Enabled)
  39         {0x3C0, 0x3C0, 0x10, 0x04},     // Mode Control (Blink Disabled)
  40         {0x3C0, 0x3C0, 0x11, 0x00},     // Overscan Register
  41         {0x3C0, 0x3C0, 0x12, 0x0F},     // Color Plane Enable
  42         {0x3C0, 0x3C0, 0x13, 0x08},     // Horizontal Panning
  43         {0x3C0, 0x3C0, 0x14, 0x00},     // Color Select
  44         {0    , 0x3C2, 0   , 0x67},     // Miscellaneous Output Register
  45         {0x3C4, 0x3C5, 0x01, 0x00},     // Clock Mode Register
  46         {0x3C4, 0x3C5, 0x03, 0x00},     // Character select
  47         {0x3C4, 0x3C5, 0x04, 0x07},     // Memory Mode Register
  48         {0x3CE, 0x3CF, 0x05, 0x10},     // Mode Register
  49         {0x3CE, 0x3CF, 0x06, 0x0E},     // Miscellaneous Register
  50         {0x3D4, 0x3D5, 0x00, 0x5F},     // Horizontal Total
  51         {0x3D4, 0x3D5, 0x01, 0x4F},     // Horizontal Display Enable End
  52         {0x3D4, 0x3D5, 0x02, 0x50},     // Horizontal Blank Start
  53         {0x3D4, 0x3D5, 0x03, 0x82},     // Horizontal Blank End
  54         {0x3D4, 0x3D5, 0x04, 0x55},     // Horizontal Retrace Start
  55         {0x3D4, 0x3D5, 0x05, 0x81},     // Horizontal Retrace End
  56         {0x3D4, 0x3D5, 0x06, 0xBF},     // Vertical Total
  57         {0x3D4, 0x3D5, 0x07, 0x1F},     // Overflow Register
  58         {0x3D4, 0x3D5, 0x08, 0x00},     // Preset row scan
  59         {0x3D4, 0x3D5, 0x09, 0x4F},     // Maximum Scan Line
  60         {0x3D4, 0x3D5, 0x10, 0x9C},     // Vertical Retrace Start
  61         {0x3D4, 0x3D5, 0x11, 0x8E},     // Vertical Retrace End
  62         {0x3D4, 0x3D5, 0x12, 0x8F},     // Vertical Display Enable End
  63         {0x3D4, 0x3D5, 0x13, 0x28},     // Logical Width
  64         {0x3D4, 0x3D5, 0x14, 0x1F},     // Underline Location
  65         {0x3D4, 0x3D5, 0x15, 0x96},     // Vertical Blank Start
  66         {0x3D4, 0x3D5, 0x16, 0xB9},     // Vertical Blank End
  67         {0x3D4, 0x3D5, 0x17, 0xA3}      // CRTC Mode Control
  68 };
  69 #define NUM_REGVALUES   (sizeof(caRegValues)/sizeof(caRegValues[0]))
  70
  71 // === GLOBALS ===
  72  int    giKP_Pos = 0;
  73
  74 // === CODE ===
  75 /**
  76  * \brief Sets the screen mode for a kernel panic
  77  */
  78 void KernelPanic_SetMode(void)
  79 {
  80          int    i;
  81
  82         // This function is called by Panic(), but MM_PageFault and the
  83         // CPU exception handers also call it, so let's not clear the screen
  84         // twice
  85         if( giKP_Pos )  return ;
  86
  87         // Restore VGA 0xB8000 text mode
  88         #if 1
  89         for( i = 0; i < NUM_REGVALUES; i++ )
  90         {
  91                 // Reset Flip-Flop
  92                 if( caRegValues[i].IdxPort == 0x3C0 )   inb(0x3DA);
  93
  94                 if( caRegValues[i].IdxPort )
  95                         outb(caRegValues[i].IdxPort, caRegValues[i].Index);
  96                 outb(caRegValues[i].DatPort, caRegValues[i].Value);
  97         }
  98
  99         inb(0x3DA);
 100         outb(0x3C0, 0x20);
 101         #endif
 102
 103         #if USE_MP
 104         // Send halt to all processors
 105         for( i = 0; i < giNumCPUs; i ++ )
 106         {
 107                 if(i == GetCPUNum())    continue ;
 108                 FB[i] = BGC|('A'+i);
 109                 MP_SendIPIVector(i, 0xED);
 110         }
 111         #endif
 112
 113         // Clear Screen
 114         for( i = 0; i < 80*25; i++ )
 115         {
 116                 FB[i] = BGC;
 117         }
 118
 119         {
 120                 Uint32  eip = GetEIP();
 121                 Uint32  ebp;
 122                 __asm__ __volatile__ ("mov %%ebp, %0" : "=r" (ebp));
 123                 Error_Backtrace(eip, ebp);
 124         }
 125 }
 126
 127 void KernelPanic_PutChar(char Ch)
 128 {
 129         if( giKP_Pos > 80*25 )  return ;
 130         switch(Ch)
 131         {
 132         case '\t':
 133                 do {
 134                         FB[giKP_Pos] &= 0xFF00;
 135                         FB[giKP_Pos++] |= ' ';
 136                 } while(giKP_Pos & 7);
 137                 break;
 138
 139         case '\n':
 140                 giKP_Pos += 80;
 141         case '\r':
 142                 giKP_Pos -= giKP_Pos % 80;
 143                 break;
 144
 145         default:
 146                 if(' ' <= Ch && Ch < 0x7F)
 147                 {
 148                         FB[giKP_Pos] &= 0xFF00;
 149                         FB[giKP_Pos] |= Ch;
 150                 }
 151                 giKP_Pos ++;
 152                 break;
 153         }
 154 }