xv6-cs450/console.c

291 lines
4.9 KiB
C
Raw Normal View History

2007-08-28 21:04:36 +02:00
// Console input and output.
// Input is from the keyboard or serial port.
// Output is written to the screen and serial port.
2007-08-28 21:04:36 +02:00
#include "types.h"
2006-06-12 17:22:12 +02:00
#include "defs.h"
2007-08-28 01:26:33 +02:00
#include "param.h"
#include "traps.h"
#include "spinlock.h"
#include "dev.h"
2006-09-07 18:52:13 +02:00
#include "mmu.h"
2007-08-08 12:29:42 +02:00
#include "proc.h"
2007-08-28 01:26:33 +02:00
#include "x86.h"
2007-08-24 22:28:08 +02:00
#define CRTPORT 0x3d4
#define BACKSPACE 0x100
2007-08-24 22:28:08 +02:00
static ushort *crt = (ushort*)0xb8000; // CGA memory
static struct {
struct spinlock lock;
int locking;
} cons;
static int panicked = 0;
2006-06-22 17:51:57 +02:00
static void
cgaputc(int c)
2006-06-12 17:22:12 +02:00
{
int pos;
// Cursor position: col + 80*row.
outb(CRTPORT, 14);
pos = inb(CRTPORT+1) << 8;
outb(CRTPORT, 15);
pos |= inb(CRTPORT+1);
if(c == '\n')
pos += 80 - pos%80;
else if(c == BACKSPACE){
if(pos > 0)
crt[--pos] = ' ' | 0x0700;
2007-08-28 20:37:41 +02:00
} else
crt[pos++] = (c&0xff) | 0x0700; // black on white
if((pos/80) >= 24){ // Scroll up.
memmove(crt, crt+80, sizeof(crt[0])*23*80);
pos -= 80;
memset(crt+pos, 0, sizeof(crt[0])*(24*80 - pos));
}
outb(CRTPORT, 14);
outb(CRTPORT+1, pos>>8);
outb(CRTPORT, 15);
outb(CRTPORT+1, pos);
crt[pos] = ' ' | 0x0700;
}
2006-06-12 17:22:12 +02:00
2007-08-30 20:21:35 +02:00
void
consputc(int c)
{
2006-07-17 03:25:22 +02:00
if(panicked){
cli();
2006-07-17 03:25:22 +02:00
for(;;)
;
}
uartputc(c);
cgaputc(c);
}
2006-06-12 17:22:12 +02:00
void
printint(int xx, int base, int sgn)
{
static char digits[] = "0123456789abcdef";
2006-06-12 17:22:12 +02:00
char buf[16];
int i = 0, neg = 0;
uint x;
2006-09-06 19:27:19 +02:00
2006-06-12 17:22:12 +02:00
if(sgn && xx < 0){
neg = 1;
x = 0 - xx;
2007-08-28 20:37:41 +02:00
} else {
2006-06-12 17:22:12 +02:00
x = xx;
}
2007-08-28 20:32:08 +02:00
do{
2006-06-12 17:22:12 +02:00
buf[i++] = digits[x % base];
2007-08-28 20:32:08 +02:00
}while((x /= base) != 0);
2006-06-12 17:22:12 +02:00
if(neg)
buf[i++] = '-';
while(--i >= 0)
consputc(buf[i]);
2006-06-12 17:22:12 +02:00
}
2007-08-28 20:23:48 +02:00
// Print to the console. only understands %d, %x, %p, %s.
2006-06-12 17:22:12 +02:00
void
cprintf(char *fmt, ...)
{
int i, c, state, locking;
uint *argp;
char *s;
2006-06-12 17:22:12 +02:00
locking = cons.locking;
if(locking)
acquire(&cons.lock);
argp = (uint*)(void*)&fmt + 1;
state = 0;
2006-06-12 17:22:12 +02:00
for(i = 0; fmt[i]; i++){
c = fmt[i] & 0xff;
switch(state){
case 0:
if(c == '%')
2006-06-12 17:22:12 +02:00
state = '%';
else
consputc(c);
break;
case '%':
switch(c){
case 'd':
printint(*argp++, 10, 1);
break;
case 'x':
case 'p':
printint(*argp++, 16, 0);
break;
case 's':
s = (char*)*argp++;
if(s == 0)
s = "(null)";
for(; *s; s++)
consputc(*s);
break;
case '%':
consputc('%');
break;
default:
// Print unknown % sequence to draw attention.
consputc('%');
consputc(c);
break;
2006-06-12 17:22:12 +02:00
}
state = 0;
break;
2006-06-12 17:22:12 +02:00
}
}
if(locking)
release(&cons.lock);
2006-06-12 17:22:12 +02:00
}
int
consolewrite(struct inode *ip, char *buf, int n)
{
int i;
iunlock(ip);
acquire(&cons.lock);
for(i = 0; i < n; i++)
consputc(buf[i] & 0xff);
release(&cons.lock);
ilock(ip);
return n;
}
#define INPUT_BUF 128
struct {
struct spinlock lock;
char buf[INPUT_BUF];
uint r; // Read index
uint w; // Write index
uint e; // Edit index
} input;
2007-08-28 06:13:40 +02:00
#define C(x) ((x)-'@') // Control-x
void
consoleintr(int (*getc)(void))
{
int c;
acquire(&input.lock);
while((c = getc()) >= 0){
switch(c){
case C('P'): // Process listing.
procdump();
break;
case C('U'): // Kill line.
while(input.e != input.w &&
input.buf[(input.e-1) % INPUT_BUF] != '\n'){
input.e--;
consputc(BACKSPACE);
}
break;
case C('H'): // Backspace
if(input.e != input.w){
input.e--;
consputc(BACKSPACE);
}
break;
default:
if(c != 0 && input.e-input.r < INPUT_BUF){
2007-08-30 20:20:53 +02:00
input.buf[input.e++ % INPUT_BUF] = c;
consputc(c);
if(c == '\n' || c == C('D') || input.e == input.r+INPUT_BUF){
input.w = input.e;
wakeup(&input.r);
}
}
break;
2006-09-07 17:45:38 +02:00
}
}
release(&input.lock);
}
int
consoleread(struct inode *ip, char *dst, int n)
{
uint target;
int c;
iunlock(ip);
target = n;
acquire(&input.lock);
while(n > 0){
while(input.r == input.w){
2007-08-10 18:37:27 +02:00
if(cp->killed){
release(&input.lock);
ilock(ip);
2007-08-08 12:29:42 +02:00
return -1;
}
sleep(&input.r, &input.lock);
2007-08-08 12:29:42 +02:00
}
2007-08-30 20:20:53 +02:00
c = input.buf[input.r++ % INPUT_BUF];
if(c == C('D')){ // EOF
if(n < target){
// Save ^D for next time, to make sure
// caller gets a 0-byte result.
input.r--;
}
break;
}
*dst++ = c;
--n;
if(c == '\n')
break;
}
release(&input.lock);
ilock(ip);
return target - n;
}
void
consoleinit(void)
{
initlock(&cons.lock, "console");
initlock(&input.lock, "input");
devsw[CONSOLE].write = consolewrite;
devsw[CONSOLE].read = consoleread;
cons.locking = 1;
picenable(IRQ_KBD);
ioapicenable(IRQ_KBD, 0);
}
void
panic(char *s)
{
int i;
uint pcs[10];
2008-10-12 22:19:16 +02:00
cli();
cons.locking = 0;
2007-09-27 22:25:32 +02:00
cprintf("cpu%d: panic: ", cpu());
cprintf(s);
cprintf("\n");
getcallerpcs(&s, pcs);
for(i=0; i<10; i++)
cprintf(" %p", pcs[i]);
panicked = 1; // freeze other CPU
for(;;)
;
}