ef2ad4cb8ec855adf33d5a8fc8d50c46283a6740
[tpg/acess2.git] / 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         __asm__ __volatile__ ("cli");   // Stop the processor!
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         #if USE_MP
88         // Send halt to all processors
89         for( int i = 0; i < giNumCPUs; i ++ )
90         {
91                 if(i == GetCPUNum())    continue ;
92                 FB[i] = BGC|('A'+i);
93                 MP_SendIPIVector(i, 0xED);
94         }
95         #endif
96         
97         #if ENABLE_KPANIC_MODE
98         // Restore VGA 0xB8000 text mode
99         #if 0
100         for( int i = 0; i < NUM_REGVALUES; i++ )
101         {
102                 // Reset Flip-Flop
103                 if( caRegValues[i].IdxPort == 0x3C0 )   inb(0x3DA);
104                 
105                 if( caRegValues[i].IdxPort )
106                         outb(caRegValues[i].IdxPort, caRegValues[i].Index);
107                 outb(caRegValues[i].DatPort, caRegValues[i].Value);
108         }
109         
110         inb(0x3DA);
111         outb(0x3C0, 0x20);
112         #endif
113         
114         // Clear Screen
115         for( int i = 0; i < 80*25; i++ )
116         {
117                 FB[i] = BGC;
118         }
119         
120         {
121                 Uint32  eip = GetEIP();
122                 Uint32  ebp;
123                 __asm__ __volatile__ ("mov %%ebp, %0" : "=r" (ebp));
124                 Error_Backtrace(eip, ebp);
125         }
126         #endif
127 }
128
129 void KernelPanic_PutChar(char Ch)
130 {
131         #if ENABLE_KPANIC_MODE
132         if( giKP_Pos > 80*25 )  return ;
133         switch(Ch)
134         {
135         case '\t':
136                 do {
137                         FB[giKP_Pos] &= 0xFF00;
138                         FB[giKP_Pos++] |= ' ';
139                 } while(giKP_Pos & 7);
140                 break;
141         
142         case '\n':
143                 giKP_Pos += 80;
144         case '\r':
145                 giKP_Pos -= giKP_Pos % 80;
146                 break;
147         
148         default:
149                 if(' ' <= Ch && Ch < 0x7F)
150                 {
151                         FB[giKP_Pos] &= 0xFF00;
152                         FB[giKP_Pos] |= Ch;
153                 }
154                 giKP_Pos ++;
155                 break;
156         }
157         #if 0
158         {
159                 char    s[2] = {Ch,0};
160                 VT_int_PutString(gpVT_CurTerm, s);
161         }
162         #endif
163         #endif // ENABLE_KPANIC_MODE
164 }

UCC git Repository :: git.ucc.asn.au