| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244 |
- /* On-screen kernel debug output: see kdbg.h. */
- #include "kdbg.h"
- #include "font_8x8.h"
- #include "timer.h"
- #include "vga.h"
- volatile unsigned int kdbg_irq_count;
- volatile unsigned int kdbg_irq_bytes;
- volatile unsigned int kdbg_irq_other;
- volatile unsigned int kdbg_last_sc;
- volatile unsigned int kdbg_irq_masked;
- volatile unsigned int kdbg_wm_count;
- volatile unsigned int kdbg_wm_last;
- volatile unsigned int kdbg_term_count;
- volatile unsigned int kdbg_term_last;
- static unsigned int fb_w, fb_h, fb_pitch, fb_bpp;
- static volatile unsigned char *fb_lfb;
- static int fb_ok;
- #define KDBG_INFO_MAX 10
- static char kdbg_info_buf[KDBG_INFO_MAX][40];
- static unsigned char kdbg_info_used[KDBG_INFO_MAX];
- void kdbg_init(void)
- {
- fb_w = vga_fb_width();
- fb_h = vga_fb_height();
- fb_pitch = vga_fb_pitch();
- fb_bpp = vga_fb_bpp();
- fb_lfb = (volatile unsigned char *)(unsigned long)vga_fb_lfb_addr();
- fb_ok = (fb_w > 0 && fb_h > 60 && fb_pitch > 0 && fb_lfb &&
- (fb_bpp == 16 || fb_bpp == 24 || fb_bpp == 32));
- }
- static void px(unsigned int x, unsigned int y,
- unsigned int r, unsigned int g, unsigned int b)
- {
- volatile unsigned char *p;
- if (!fb_ok || x >= fb_w || y >= fb_h)
- return;
- p = fb_lfb + (unsigned long)y * fb_pitch + (unsigned long)x * (fb_bpp / 8);
- if (fb_bpp == 16) {
- unsigned int v = ((r >> 3) << 11) | ((g >> 2) << 5) | (b >> 3);
- p[0] = (unsigned char)(v & 0xFF);
- p[1] = (unsigned char)(v >> 8);
- } else if (fb_bpp == 24) {
- p[0] = (unsigned char)b;
- p[1] = (unsigned char)g;
- p[2] = (unsigned char)r;
- } else {
- p[0] = (unsigned char)b;
- p[1] = (unsigned char)g;
- p[2] = (unsigned char)r;
- p[3] = 0;
- }
- }
- static void rect(unsigned int x, unsigned int y, unsigned int w, unsigned int h,
- unsigned int r, unsigned int g, unsigned int b)
- {
- unsigned int i, j;
- for (j = 0; j < h; j++)
- for (i = 0; i < w; i++)
- px(x + i, y + j, r, g, b);
- }
- static void draw_ch(unsigned int x, unsigned int y, char c, unsigned int sc,
- unsigned int r, unsigned int g, unsigned int b)
- {
- const unsigned char *gl = &font_8x8[(unsigned char)c * 8];
- unsigned int row, col, i, j;
- for (row = 0; row < 8; row++) {
- unsigned char bits = gl[row];
- for (col = 0; col < 8; col++) {
- if (bits & (0x80 >> col)) {
- for (i = 0; i < sc; i++)
- for (j = 0; j < sc; j++)
- px(x + col * sc + i,
- y + row * sc + j, r, g, b);
- }
- }
- }
- }
- static void draw_str(unsigned int x, unsigned int y, unsigned int sc,
- const char *s, unsigned int r, unsigned int g, unsigned int b)
- {
- while (*s) {
- draw_ch(x, y, *s, sc, r, g, b);
- x += 8 * sc;
- s++;
- }
- }
- static unsigned int app_str(char *buf, unsigned int i, const char *s)
- {
- while (*s)
- buf[i++] = *s++;
- return i;
- }
- static unsigned int app_dec(char *buf, unsigned int i, unsigned int v)
- {
- char tmp[11];
- unsigned int n = 0, j;
- if (v == 0) {
- buf[i++] = '0';
- return i;
- }
- while (v) {
- tmp[n++] = (char)('0' + v % 10);
- v /= 10;
- }
- for (j = n; j > 0; j--)
- buf[i++] = tmp[j - 1];
- return i;
- }
- static unsigned int app_hex(char *buf, unsigned int i, unsigned int v,
- unsigned int digits)
- {
- static const char hx[] = "0123456789ABCDEF";
- unsigned int d;
- for (d = 0; d < digits; d++)
- buf[i++] = hx[(v >> (4 * (digits - 1 - d))) & 0xF];
- return i;
- }
- static void kdbg_draw_info_row(unsigned int row)
- {
- unsigned int y;
- if (!fb_ok || row >= KDBG_INFO_MAX || !kdbg_info_used[row])
- return;
- y = fb_h - 31 - row * 10;
- rect(0, y, 400, 9, 0, 0, 0);
- draw_str(1, y, 1, kdbg_info_buf[row], 255, 220, 80);
- }
- void kdbg_info(unsigned int row, const char *s)
- {
- unsigned int i = 0;
- if (row >= KDBG_INFO_MAX)
- return;
- while (s[i] && i < sizeof(kdbg_info_buf[0]) - 1) {
- kdbg_info_buf[row][i] = s[i];
- i++;
- }
- kdbg_info_buf[row][i] = '\0';
- kdbg_info_used[row] = 1;
- kdbg_draw_info_row(row);
- }
- static void kdbg_redraw_info(void)
- {
- unsigned int r;
- for (r = 0; r < KDBG_INFO_MAX; r++)
- kdbg_draw_info_row(r);
- }
- void kdbg_status(void)
- {
- char buf[96];
- unsigned int i;
- if (!fb_ok)
- return;
- i = 0;
- i = app_str(buf, i, "IRQ ");
- i = app_dec(buf, i, kdbg_irq_count);
- i = app_str(buf, i, " SC ");
- i = app_hex(buf, i, kdbg_last_sc, 2);
- i = app_str(buf, i, " BY ");
- i = app_dec(buf, i, kdbg_irq_bytes);
- i = app_str(buf, i, " OT ");
- i = app_dec(buf, i, kdbg_irq_other);
- i = app_str(buf, i, " MK ");
- i = app_dec(buf, i, kdbg_irq_masked);
- buf[i] = '\0';
- rect(0, fb_h - 21, 400, 9, 0, 0, 0);
- draw_str(1, fb_h - 21, 1, buf, 120, 255, 120);
- i = 0;
- i = app_str(buf, i, "WM ");
- i = app_dec(buf, i, kdbg_wm_count);
- i = app_str(buf, i, " K ");
- i = app_hex(buf, i, kdbg_wm_last, 4);
- i = app_str(buf, i, " TRM ");
- i = app_dec(buf, i, kdbg_term_count);
- i = app_str(buf, i, " K ");
- i = app_hex(buf, i, kdbg_term_last, 4);
- buf[i] = '\0';
- rect(0, fb_h - 11, 400, 9, 0, 0, 0);
- draw_str(1, fb_h - 11, 1, buf, 120, 180, 255);
- kdbg_redraw_info();
- }
- /* Called from the PIT IRQ (~1 kHz). */
- void kdbg_pit_tick(void)
- {
- static unsigned int n;
- n++;
- if (!fb_ok)
- return;
- if ((n % 500) == 0) {
- int on = (int)((n / 500) & 1);
- /* 1 Hz heartbeat square, bottom-right corner. */
- rect(fb_w - 12, fb_h - 12, 10, 10,
- on ? 0 : 60, on ? 255 : 60, on ? 0 : 60);
- }
- if ((n % 1000) == 0)
- kdbg_status();
- }
- void kdbg_panic(const char *name, unsigned int eip, unsigned int cr2)
- {
- char buf[64];
- unsigned int i = 0;
- if (!fb_ok)
- return;
- rect(0, 0, fb_w, 52, 140, 0, 0);
- draw_str(4, 4, 2, "*** EXCEPTION ***", 255, 255, 255);
- draw_str(4, 26, 1, name, 255, 255, 0);
- i = app_str(buf, i, "EIP ");
- i = app_hex(buf, i, eip, 8);
- i = app_str(buf, i, " CR2 ");
- i = app_hex(buf, i, cr2, 8);
- buf[i] = '\0';
- draw_str(4, 38, 1, buf, 255, 200, 200);
- kdbg_status();
- }
|