123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127 |
- #include "u.h"
- #include "../port/lib.h"
- #include "mem.h"
- #include "dat.h"
- #include "fns.h"
- #include "../port/error.h"
- enum {
- Black,
- Blue,
- Green,
- Cyan,
- Red,
- Magenta,
- Brown,
- Grey,
- Bright = 0x08,
- Blinking = 0x80,
- Yellow = Bright|Brown,
- White = Bright|Grey,
- };
-
- enum {
- Width = 80*2,
- Height = 25,
- Attr = (Black<<4)|Grey, /* high nibble background
- * low foreground
- */
- };
- #define CGASCREENBASE ((uchar*)KADDR(0xB8000))
- static int cgapos;
- static Lock cgascreenlock;
- static uchar
- cgaregr(int index)
- {
- outb(0x3D4, index);
- return inb(0x3D4+1) & 0xFF;
- }
- static void
- cgaregw(int index, int data)
- {
- outb(0x3D4, index);
- outb(0x3D4+1, data);
- }
- static void
- movecursor(void)
- {
- cgaregw(0x0E, (cgapos/2>>8) & 0xFF);
- cgaregw(0x0F, cgapos/2 & 0xFF);
- CGASCREENBASE[cgapos+1] = Attr;
- }
- static void
- cgascreenputc(int c)
- {
- int i;
- uchar *p;
- if(c == '\n'){
- cgapos = cgapos/Width;
- cgapos = (cgapos+1)*Width;
- }
- else if(c == '\t'){
- i = 8 - ((cgapos/2)&7);
- while(i-->0)
- cgascreenputc(' ');
- }
- else if(c == '\b'){
- if(cgapos >= 2)
- cgapos -= 2;
- cgascreenputc(' ');
- cgapos -= 2;
- }
- else{
- CGASCREENBASE[cgapos++] = c;
- CGASCREENBASE[cgapos++] = Attr;
- }
- if(cgapos >= Width*Height){
- memmove(CGASCREENBASE, &CGASCREENBASE[Width], Width*(Height-1));
- p = &CGASCREENBASE[Width*(Height-1)];
- for(i=0; i<Width/2; i++){
- *p++ = ' ';
- *p++ = Attr;
- }
- cgapos = Width*(Height-1);
- }
- movecursor();
- }
- static void
- cgascreenputs(char* s, int n)
- {
- if(!islo()){
- /*
- * Don't deadlock trying to
- * print in an interrupt.
- */
- if(!canlock(&cgascreenlock))
- return;
- }
- else
- lock(&cgascreenlock);
- while(n-- > 0)
- cgascreenputc(*s++);
- unlock(&cgascreenlock);
- }
- void
- screeninit(void)
- {
- cgapos = cgaregr(0x0E)<<8;
- cgapos |= cgaregr(0x0F);
- cgapos *= 2;
- screenputs = cgascreenputs;
- }
|