X-Git-Url: http://v3vee.org/palacios/gitweb/gitweb.cgi?a=blobdiff_plain;f=linux_usr%2Fv3_cons_sc.c;h=6272357408e562515b10b9dce9c805ac2ecd0d54;hb=a569df65eac9f48c73e30f85afbb385f65c2eb38;hp=3b9e1923f64a30dfc704fbc20d3dca676bbd7c7f;hpb=840a7c8a40cbb875c1c748845f093ff898e99766;p=palacios.git diff --git a/linux_usr/v3_cons_sc.c b/linux_usr/v3_cons_sc.c index 3b9e192..6272357 100644 --- a/linux_usr/v3_cons_sc.c +++ b/linux_usr/v3_cons_sc.c @@ -2,6 +2,7 @@ * V3 Console utility * Taken from Palacios console display in MINIX ( by Erik Van der Kouwe ) * (c) Jack lange, 2010 + * (c) Peter Dinda, 2011 (Scan code encoding) */ @@ -20,8 +21,12 @@ #include "v3_ctrl.h" +static int in_color = 0; +static int color8 = 0; +#define TRANS_STYLE(x) ( !color8 ? (x) : ((x)&0x7)|(((x)&0x70)>>1)) + static int use_curses = 0; -static int debug_enable = 1; +static int debug_enable = 0; typedef enum { CONSOLE_CURS_SET = 1, @@ -91,7 +96,9 @@ static int handle_char_set(struct character_msg * msg) { if ((c < ' ') || (c >= 127)) { - fprintf(stderr, "unexpected control character %d\n", c); + if (debug_enable) { + fprintf(stderr, "unexpected control character %d\n", c); + } c = '?'; } @@ -101,8 +108,11 @@ static int handle_char_set(struct character_msg * msg) { (msg->x > console.win->_maxx) || (msg->y > console.win->_maxy)) { - fprintf(stderr, "Char out of range (x=%d,y=%d) MAX:(x=%d,y=%d)\n", - msg->x, msg->y, console.win->_maxx, console.win->_maxy); + if (debug_enable) { + fprintf(stderr, "Char out of range (x=%d,y=%d) MAX:(x=%d,y=%d)\n", + msg->x, msg->y, console.win->_maxx, console.win->_maxy); + } + return -1; } @@ -111,7 +121,9 @@ static int handle_char_set(struct character_msg * msg) { return -1; } + if (in_color) {wattron(console.win, COLOR_PAIR(TRANS_STYLE(msg->style)));} mvwaddch(console.win, msg->y, msg->x, c); + if (in_color) {wattroff(console.win, COLOR_PAIR(TRANS_STYLE(msg->style)));} } else { //stdout text display @@ -257,7 +269,9 @@ int send_key(int cons_fd, char scan_code) { void handle_exit(void) { - fprintf(stderr, "Exiting from console terminal\n"); + if ( debug_enable ) { + fprintf(stderr, "Exiting from console terminal\n"); + } if (use_curses) { endwin(); @@ -277,8 +291,8 @@ struct key_code { }; static const struct key_code ascii_to_key_code[] = { // ASCII Value Serves as Index - NO_KEY, NO_KEY, NO_KEY, NO_KEY, // 0x00 - 0x03 - NO_KEY, NO_KEY, NO_KEY, NO_KEY, // 0x04 - 0x07 + NO_KEY, NO_KEY, {0x50, 0}, {0x48, 0}, // 0x00 - 0x03 + {0x4B, 0}, {0x4D, 0}, NO_KEY, { 0x0E, 0 }, // 0x04 - 0x07 { 0x0E, 0 }, { 0x0F, 0 }, { 0x1C, 0 }, NO_KEY, // 0x08 - 0x0B NO_KEY, { 0x1C, 0 }, NO_KEY, NO_KEY, // 0x0C - 0x0F NO_KEY, NO_KEY, NO_KEY, NO_KEY, // 0x10 - 0x13 @@ -313,19 +327,23 @@ static const struct key_code ascii_to_key_code[] = { // ASCII Value -#define writeit(fd,c) do { fprintf(stderr,"scancode 0x%x\n",(c)); if (write((fd),&(c),1)!=1) { return -1; } } while (0) +#define writeit(fd,c) do { if (debug_enable) { fprintf(stderr,"scancode 0x%x\n",(c));} if (write((fd),&(c),1)!=1) { return -1; } } while (0) int send_char_to_palacios_as_scancodes(int fd, unsigned char c) { unsigned char sc; - fprintf(stderr,"key '%c'\n",c); + if (debug_enable) { + fprintf(stderr,"key '%c'\n",c); + } if (c<0x80) { struct key_code k = ascii_to_key_code[c]; if (k.scan_code==0 && k.capital==0) { - fprintf(stderr,"Cannot send key '%c' to palacios as it maps to no scancode\n",c); + if (debug_enable) { + fprintf(stderr,"Cannot send key '%c' to palacios as it maps to no scancode\n",c); + } } else { if (k.capital) { //shift down @@ -350,141 +368,102 @@ int send_char_to_palacios_as_scancodes(int fd, unsigned char c) } else { - - fprintf(stderr,"Cannot send key '%c' to palacios because it is >=0x80\n",c); - -/* switch (key) { */ -/* case 0xffe1: //left shift */ -/* scancode = 0x2a; */ -/* break; */ - -/* case 0xffe2: //right shift */ -/* scancode = 0x36; */ -/* break; */ - -/* case 0xffe3: //left ctrl */ -/* case 0xffe4: //right ctrl */ -/* scancode = 0x1d; // translated as left ctrl */ -/* break; */ - -/* case 0xffe7: //left meta */ -/* case 0xffe8: //right meta */ -/* case 0xffe9: //left alt */ -/* case 0xffea: //right alt */ -/* scancode = 0x38; // translated as a left alt */ -/* break; */ - -/* case 0xff08: // backspace */ -/* scancode = 0x0e; */ -/* break; */ - -/* case 0xff09: // tab */ -/* scancode = 0x0f; */ -/* break; */ - -/* case 0xff0d: // return */ -/* scancode = 0x1c; */ -/* break; */ - -/* case 0xff1b: // escape */ -/* scancode = 0x01; */ -/* break; */ - -/* case 0xff63: // insert */ -/* scancode = 0x52; */ -/* break; */ - -/* case 0xffff: // delete */ -/* scancode = 0x53; */ -/* break; */ - -/* case 0xff50: // home */ -/* scancode = 0x47; */ -/* break; */ - -/* case 0xff57: // end */ -/* scancode = 0x4f; */ -/* break; */ - -/* case 0xff55: // pageup */ -/* scancode = 0x49; */ -/* break; */ - -/* case 0xff56: // pagedown */ -/* scancode = 0x51; */ -/* break; */ - -/* case 0xff51: // left */ -/* scancode = 0x4b; */ -/* break; */ - -/* case 0xff52: // up */ -/* scancode = 0x48; */ -/* break; */ - -/* case 0xff53: // right */ -/* scancode = 0x4d; */ -/* break; */ - -/* case 0xff54: // down */ -/* scancode = 0x50; */ -/* break; */ - -/* case 0xffbe: // f1 */ -/* scancode = 0x3b; */ -/* break; */ -/* case 0xffbf: // f2 */ -/* scancode = 0x3c; */ -/* break; */ -/* case 0xffc0: // f3 */ -/* scancode = 0x3d; */ -/* break; */ -/* case 0xffc1: // f4 */ -/* scancode = 0x3e; */ -/* break; */ -/* case 0xffc2: // f5 */ -/* scancode = 0x3f; */ -/* break; */ -/* case 0xffc3: // f6 */ -/* scancode = 0x40; */ -/* break; */ -/* case 0xffc4: // f7 */ -/* scancode = 0x41; */ -/* break; */ -/* case 0xffc5: // f8 */ -/* scancode = 0x42; */ -/* break; */ -/* case 0xffc6: // f9 */ -/* scancode = 0x43; */ -/* break; */ -/* case 0xffc7: // f10 */ -/* scancode = 0x44; */ -/* break; */ -/* case 0xffc8: // f11 */ -/* scancode = 0x57; */ -/* break; */ -/* case 0xffc9: // f12 */ -/* scancode = 0x58; */ -/* break; */ - - -/* default: */ -/* scancode = 0; */ -/* fprintf(stderr,"Ignoring key 0x%x (down=%d)\n", key, down); */ -/* } */ -/* } */ - -/* if (scancode==0) { */ -/* return 0; */ -/* } */ - -/* return scancode; */ + if (debug_enable) { + fprintf(stderr,"Cannot send key '%c' to palacios because it is >=0x80\n",c); + } + } return 0; } + + +#define MIN_TTY_COLS 80 +#define MIN_TTY_ROWS 25 +int check_terminal_size (void) +{ + unsigned short n_cols = 0; + unsigned short n_rows = 0; + struct winsize winsz; + + ioctl (fileno(stdin), TIOCGWINSZ, &winsz); + n_cols = winsz.ws_col; + n_rows = winsz.ws_row; + + if (n_cols < MIN_TTY_COLS || n_rows < MIN_TTY_ROWS) { + printf ("Your window is not large enough.\n"); + printf ("It must be at least %dx%d, but yours is %dx%d\n", + MIN_TTY_COLS, MIN_TTY_ROWS, n_cols, n_rows); + return (-1); + } + + /* SUCCESS */ + return (0); +} + + + +static void +init_colors (void) +{ + unsigned short i; + + if (!has_colors()) { + fprintf(stderr,"No color support\n"); + in_color=0; + color8=0; + return; + } + start_color(); + + if (can_change_color() && COLORS>=16 && COLOR_PAIRS>=256) { + fprintf(stderr, "Modifyable color support with enough colors available\n"); + // initialize first 16 colors to be the PC colors + // then create all the pairings + for (i=0;i<16;i++) { + unsigned short red, green, blue, intens; + // i = IRGB (4 bits) + intens = i>>3 & 0x1; + red = i>>2 & 0x1; + green = i>>1 & 0x1; + blue = i>>0 & 0x1; + init_color(i, 500*(red+intens), 500*(blue+intens), 500*(green+intens)); + } + for (i=0;i<256;i++) { + init_pair(i, i & 0xf, (i >> 4) & 0xf); + } + in_color = 1; + color8 = 0; + return; + } else { + if (COLORS!=8 || COLOR_PAIRS<64) { + fprintf(stderr,"Insufficient number of fixed colors (%d) or color pairs (%d)\n",COLORS,COLOR_PAIRS); + in_color = 0; + color8 = 0; + return; + } + // We have only the low-intensity colors available, so + // map just to these + fprintf(stderr,"Only 8 color standard palette available\n"); + for (i=0;i<64;i++) { + // VGA color order: black, blue, green, cyan, red, magenta, brown, gray + // curses color order: black, red, green, yellow, blue, magenta, cyan, white + short map[] = { 0, 4, 2, 6, 1, 5, 3, 7 }; + unsigned short fg, bg; + // discard intensity bit + bg = (i>>3 & 0x7); + fg = i & 0x7; + init_pair(i, map[fg], map[bg]); + } + in_color = 1; + color8 = 1; + return; + } +} + + int main(int argc, char* argv[]) { int vm_fd; int cons_fd; @@ -494,13 +473,17 @@ int main(int argc, char* argv[]) { use_curses = 1; if (argc < 2) { - printf("Usage: ./v3_cons \n"); + printf("usage: v3_cons_sc \n"); return -1; } - vm_dev = argv[1]; - + /* Check for minimum Terminal size at start */ + if (0 != check_terminal_size()) { + printf ("Error: terminal too small!\n"); + return -1; + } + vm_dev = argv[1]; vm_fd = open(vm_dev, O_RDONLY); @@ -536,6 +519,10 @@ int main(int argc, char* argv[]) { } scrollok(console.win, 1); + + erase(); + init_colors(); + //abort(); } /* @@ -590,26 +577,40 @@ int main(int argc, char* argv[]) { } } - if (FD_ISSET(STDIN_FILENO, &rset)) { - unsigned char key = getch(); - - if (key == '\\') { // ESC - break; - } else if (key == '`') { - unsigned char sc = 0x44; // F10 - writeit(cons_fd,sc); - sc |= 0x80; - writeit(cons_fd,sc); - }else { - if (send_char_to_palacios_as_scancodes(cons_fd,key)) { - fprintf(stderr, "Error sendign key to console\n"); - return -1; - } - } + if (FD_ISSET(STDIN_FILENO, &rset)) { + unsigned char key = getch(); + + if (key == '\\') { // ESC + break; + } else if (key == '`') { + unsigned char sc = 0x44; // F10 + writeit(cons_fd,sc); + sc |= 0x80; + writeit(cons_fd,sc); + } else if (key == '~') { // CTRL-C + unsigned char sc; + sc = 0x1d; // left ctrl down + writeit(cons_fd,sc); + sc = 0x2e; // c down + writeit(cons_fd,sc); + sc = 0x2e | 0x80; // c up + writeit(cons_fd,sc); + sc = 0x1d | 0x80; // left ctrl up + writeit(cons_fd,sc); + } else { + if (send_char_to_palacios_as_scancodes(cons_fd,key)) { + printf("Error sending key to console\n"); + return -1; + } + } } } + erase(); + + printf("Console terminated\n"); + close(cons_fd); return 0;