/* Serial debug monitor. Entered via the `dbg` command and driven from the host * with `make monitor` (picocom). ASCII commands, newline-terminated, hex args: * * r read len bytes at addr -> hex dump * w [b1 ...] write bytes at addr * i inb (read I/O port) * o outb (write I/O port) * h help * q quit * * Runs inline (blocks the terminal), so it owns the serial ring buffer and * doesn't conflict with the kexec auto-detect in the terminal idle loop. */ #include "dbg.h" #include "paging.h" #include "serial.h" #define DBG_LINE_MAX 64 #define DBG_NARGS 32 #define DBG_READ_MAX 256 static inline unsigned char dbg_inb(unsigned short port) { unsigned char v; __asm__ volatile ("inb %1, %0" : "=a"(v) : "Nd"(port)); return v; } static inline void dbg_outb(unsigned short port, unsigned char v) { __asm__ volatile ("outb %0, %1" : : "a"(v), "Nd"(port)); } static void dbg_putbyte(unsigned char b) { static const char hex[] = "0123456789ABCDEF"; serial_putc(SERIAL_COM1, hex[b >> 4]); serial_putc(SERIAL_COM1, hex[b & 0xF]); } /* Block until a byte arrives (echoing it so picocom works without local echo). */ static void dbg_getc(unsigned char *c) { for (;;) { if (!serial_ring_wait(0xFFFFFFFFu, c)) continue; /* timeout (effectively never) */ if (*c == '\r') ; /* ignore bare CR */ else if (*c == '\n') serial_puts(SERIAL_COM1, "\n"); else serial_putc(SERIAL_COM1, (char)*c); return; } } static void dbg_read_line(char *buf, unsigned int max) { unsigned int i = 0; unsigned char c; for (;;) { dbg_getc(&c); if (c == '\n' || c == '\r') break; if (i + 1 < max) buf[i++] = (char)c; } buf[i] = '\0'; } /* Parse a hex number at *s (optional 0x prefix); advance *s past it. */ static int dbg_parse_hex(const char **s, unsigned int *out) { const char *p = *s; unsigned int v = 0; int digits = 0; if (p[0] == '0' && (p[1] == 'x' || p[1] == 'X')) p += 2; for (;; p++) { unsigned int d; char c = *p; if (c >= '0' && c <= '9') d = (unsigned int)(c - '0'); else if (c >= 'a' && c <= 'f') d = (unsigned int)(c - 'a' + 10); else if (c >= 'A' && c <= 'F') d = (unsigned int)(c - 'A' + 10); else break; v = (v << 4) | d; digits++; } if (!digits) return 0; *out = v; *s = p; return 1; } /* Returns 1 to quit. */ static int dbg_command(const char *line) { const char *p = line; unsigned int args[DBG_NARGS]; unsigned int nargs = 0; char cmd; while (*p == ' ') p++; if (!*p) return 0; cmd = *p++; while (nargs < DBG_NARGS) { while (*p == ' ') p++; if (!*p) break; if (!dbg_parse_hex(&p, &args[nargs])) break; nargs++; } switch (cmd) { case 'r': if (nargs < 2) { serial_puts(SERIAL_COM1, "usage: r \n"); } else { unsigned int addr = args[0]; unsigned int len = args[1]; unsigned int i; if (len > DBG_READ_MAX) len = DBG_READ_MAX; serial_puthex(SERIAL_COM1, addr); serial_putc(SERIAL_COM1, ':'); for (i = 0; i < len; i++) { volatile unsigned char *b; void *km; serial_putc(SERIAL_COM1, ' '); b = paging_debug_map(addr + i, &km); if (!b) { serial_puts(SERIAL_COM1, "??"); continue; } dbg_putbyte(*b); if (km) kunmap(km); } serial_putc(SERIAL_COM1, '\n'); } return 0; case 'w': if (nargs < 2) { serial_puts(SERIAL_COM1, "usage: w [b1 ...]\n"); } else { unsigned int addr = args[0]; unsigned int i; for (i = 1; i < nargs; i++) { void *km; volatile unsigned char *b = paging_debug_map(addr + i - 1, &km); if (!b) break; *b = (unsigned char)args[i]; if (km) kunmap(km); } serial_puts(SERIAL_COM1, "ok\n"); } return 0; case 'i': if (nargs < 1) { serial_puts(SERIAL_COM1, "usage: i \n"); } else { serial_puthex(SERIAL_COM1, args[0]); serial_puts(SERIAL_COM1, " = "); dbg_putbyte(dbg_inb((unsigned short)args[0])); serial_putc(SERIAL_COM1, '\n'); } return 0; case 'o': if (nargs < 2) { serial_puts(SERIAL_COM1, "usage: o \n"); } else { dbg_outb((unsigned short)args[0], (unsigned char)args[1]); serial_puts(SERIAL_COM1, "ok\n"); } return 0; case 'h': serial_puts(SERIAL_COM1, "r read memory (hex dump)\n" "w ... write bytes\n" "i inb\n" "o outb\n" "h help\n" "q quit\n"); return 0; case 'q': return 1; default: serial_puts(SERIAL_COM1, "unknown cmd (h for help)\n"); return 0; } } void program_dbg_main(void) { char line[DBG_LINE_MAX]; serial_puts(SERIAL_COM1, "\ndbg: ready (h for help)\n"); for (;;) { serial_puts(SERIAL_COM1, "dbg> "); dbg_read_line(line, DBG_LINE_MAX); if (dbg_command(line)) break; } serial_puts(SERIAL_COM1, "dbg: bye\n"); }