From: Jack Lange Date: Fri, 26 Aug 2011 20:21:29 +0000 (-0400) Subject: added scancode converting console X-Git-Url: http://v3vee.org/palacios/gitweb/gitweb.cgi?a=commitdiff_plain;h=840a7c8a40cbb875c1c748845f093ff898e99766;p=palacios.git added scancode converting console --- diff --git a/linux_usr/v3_cons_sc.c b/linux_usr/v3_cons_sc.c new file mode 100644 index 0000000..3b9e192 --- /dev/null +++ b/linux_usr/v3_cons_sc.c @@ -0,0 +1,618 @@ +/* + * V3 Console utility + * Taken from Palacios console display in MINIX ( by Erik Van der Kouwe ) + * (c) Jack lange, 2010 + */ + + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "v3_ctrl.h" + +static int use_curses = 0; +static int debug_enable = 1; + + +typedef enum { CONSOLE_CURS_SET = 1, + CONSOLE_CHAR_SET = 2, + CONSOLE_SCROLL = 3, + CONSOLE_UPDATE = 4, + CONSOLE_RESOLUTION = 5 } console_op_t; + + + +static struct { + WINDOW * win; + int x; + int y; + int rows; + int cols; + struct termios termios_old; + unsigned char old_kbd_mode; +} console; + + +struct cursor_msg { + int x; + int y; +} __attribute__((packed)); + +struct character_msg { + int x; + int y; + char c; + unsigned char style; +} __attribute__((packed)); + +struct scroll_msg { + int lines; +} __attribute__((packed)); + +struct resolution_msg { + int cols; + int rows; +} __attribute__((packed)); + + +struct cons_msg { + unsigned char op; + union { + struct cursor_msg cursor; + struct character_msg character; + struct scroll_msg scroll; + struct resolution_msg resolution; + }; +} __attribute__((packed)); + + + + +static int handle_char_set(struct character_msg * msg) { + char c = msg->c; + + if (debug_enable) { + fprintf(stderr, "setting char (%c), at (x=%d, y=%d)\n", c, msg->x, msg->y); + } + + if (c == 0) { + c = ' '; + } + + + if ((c < ' ') || (c >= 127)) { + fprintf(stderr, "unexpected control character %d\n", c); + c = '?'; + } + + if (use_curses) { + /* clip whatever falls outside the visible area to avoid errors */ + if ((msg->x < 0) || (msg->y < 0) || + (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); + return -1; + } + + if ((msg->x == console.win->_maxx) && + (msg->y == console.win->_maxy)) { + return -1; + } + + mvwaddch(console.win, msg->y, msg->x, c); + + } else { + //stdout text display + while (console.y < msg->y) { + printf("\n"); + console.x = 0; + console.y++; + } + + while (console.x < msg->x) { + printf(" "); + console.x++; + } + + printf("%c", c); + console.x++; + + assert(console.x <= console.cols); + + if (console.x == console.cols) { + printf("\n"); + console.x = 0; + console.y++; + } + } + + return 0; +} + +int handle_curs_set(struct cursor_msg * msg) { + if (debug_enable) { + fprintf(stderr, "cursor set: (x=%d, y=%d)\n", msg->x, msg->y); + } + + if (use_curses) { + /* nothing to do now, cursor is set before update to make sure it isn't + * affected by character_set + */ + + console.x = msg->x; + console.y = msg->y; + } + + return 0; +} + + +int handle_scroll(struct scroll_msg * msg) { + int lines = msg->lines; + + if (debug_enable) { + fprintf(stderr, "scroll: %d lines\n", lines); + } + + + assert(lines >= 0); + + if (use_curses) { + while (lines > 0) { + scroll(console.win); + lines--; + } + } else { + console.y -= lines; + } +} + +int handle_text_resolution(struct resolution_msg * msg) { + if (debug_enable) { + fprintf(stderr, "text resolution: rows=%d, cols=%d\n", msg->rows, msg->cols); + } + + + console.rows = msg->rows; + console.cols = msg->cols; + + return 0; +} + +int handle_update( void ) { + if (debug_enable) { + fprintf(stderr, "update\n"); + } + + if (use_curses) { + + if ( (console.x >= 0) && (console.y >= 0) && + (console.x <= console.win->_maxx) && + (console.y <= console.win->_maxy) ) { + + wmove(console.win, console.y, console.x); + + } + + wrefresh(console.win); + } else { + fflush(stdout); + } +} + + +int handle_console_msg(int cons_fd) { + int ret = 0; + struct cons_msg msg; + + ret = read(cons_fd, &msg, sizeof(struct cons_msg)); + + switch (msg.op) { + case CONSOLE_CURS_SET: + // printf("Console cursor set (x=%d, y=%d)\n", msg.cursor.x, msg.cursor.y); + handle_curs_set(&(msg.cursor)); + break; + case CONSOLE_CHAR_SET: + handle_char_set(&(msg.character)); + /* printf("Console character set (x=%d, y=%d, c=%c, style=%c)\n", + msg.character.x, msg.character.y, msg.character.c, msg.character.style);*/ + break; + case CONSOLE_SCROLL: + // printf("Console scroll (lines=%d)\n", msg.scroll.lines); + handle_scroll(&(msg.scroll)); + break; + case CONSOLE_UPDATE: + // printf("Console update\n"); + handle_update(); + break; + case CONSOLE_RESOLUTION: + handle_text_resolution(&(msg.resolution)); + break; + default: + printf("Invalid console message operation (%d)\n", msg.op); + break; + } + + return 0; +} + + +int send_key(int cons_fd, char scan_code) { + + return 0; +} + + + +void handle_exit(void) { + fprintf(stderr, "Exiting from console terminal\n"); + + if (use_curses) { + endwin(); + } + + // tcsetattr(STDIN_FILENO, TCSANOW, &console.termios_old); + + // ioctl(STDIN_FILENO, KDSKBMODE, K_XLATE); +} + + +#define NO_KEY { 0, 0 } + +struct key_code { + unsigned char scan_code; + unsigned char capital; +}; + +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 + { 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 + NO_KEY, NO_KEY, NO_KEY, NO_KEY, // 0x14 - 0x17 + NO_KEY, NO_KEY, NO_KEY, { 0x01, 0 }, // 0x18 - 0x1B + NO_KEY, NO_KEY, NO_KEY, NO_KEY, // 0x1C - 0x1F + { 0x39, 0 }, { 0x02, 1 }, { 0x28, 1 }, { 0x04, 1 }, // 0x20 - 0x23 + { 0x05, 1 }, { 0x06, 1 }, { 0x08, 1 }, { 0x28, 0 }, // 0x24 - 0x27 + { 0x0A, 1 }, { 0x0B, 1 }, { 0x09, 1 }, { 0x0D, 1 }, // 0x28 - 0x2B + { 0x33, 0 }, { 0x0C, 0 }, { 0x34, 0 }, { 0x35, 0 }, // 0x2C - 0x2F + { 0x0B, 0 }, { 0x02, 0 }, { 0x03, 0 }, { 0x04, 0 }, // 0x30 - 0x33 + { 0x05, 0 }, { 0x06, 0 }, { 0x07, 0 }, { 0x08, 0 }, // 0x34 - 0x37 + { 0x09, 0 }, { 0x0A, 0 }, { 0x27, 1 }, { 0x27, 0 }, // 0x38 - 0x3B + { 0x33, 1 }, { 0x0D, 0 }, { 0x34, 1 }, { 0x35, 1 }, // 0x3C - 0x3F + { 0x03, 1 }, { 0x1E, 1 }, { 0x30, 1 }, { 0x2E, 1 }, // 0x40 - 0x43 + { 0x20, 1 }, { 0x12, 1 }, { 0x21, 1 }, { 0x22, 1 }, // 0x44 - 0x47 + { 0x23, 1 }, { 0x17, 1 }, { 0x24, 1 }, { 0x25, 1 }, // 0x48 - 0x4B + { 0x26, 1 }, { 0x32, 1 }, { 0x31, 1 }, { 0x18, 1 }, // 0x4C - 0x4F + { 0x19, 1 }, { 0x10, 1 }, { 0x13, 1 }, { 0x1F, 1 }, // 0x50 - 0x53 + { 0x14, 1 }, { 0x16, 1 }, { 0x2F, 1 }, { 0x11, 1 }, // 0x54 - 0x57 + { 0x2D, 1 }, { 0x15, 1 }, { 0x2C, 1 }, { 0x1A, 0 }, // 0x58 - 0x5B + { 0x2B, 0 }, { 0x1B, 0 }, { 0x07, 1 }, { 0x0C, 1 }, // 0x5C - 0x5F + { 0x29, 0 }, { 0x1E, 0 }, { 0x30, 0 }, { 0x2E, 0 }, // 0x60 - 0x63 + { 0x20, 0 }, { 0x12, 0 }, { 0x21, 0 }, { 0x22, 0 }, // 0x64 - 0x67 + { 0x23, 0 }, { 0x17, 0 }, { 0x24, 0 }, { 0x25, 0 }, // 0x68 - 0x6B + { 0x26, 0 }, { 0x32, 0 }, { 0x31, 0 }, { 0x18, 0 }, // 0x6C - 0x6F + { 0x19, 0 }, { 0x10, 0 }, { 0x13, 0 }, { 0x1F, 0 }, // 0x70 - 0x73 + { 0x14, 0 }, { 0x16, 0 }, { 0x2F, 0 }, { 0x11, 0 }, // 0x74 - 0x77 + { 0x2D, 0 }, { 0x15, 0 }, { 0x2C, 0 }, { 0x1A, 1 }, // 0x78 - 0x7B + { 0x2B, 1 }, { 0x1B, 1 }, { 0x29, 1 }, { 0x0E, 0 } // 0x7C - 0x7F +}; + + + +#define writeit(fd,c) do { 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 (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); + } else { + if (k.capital) { + //shift down + sc = 0x2a ; // left shift down + writeit(fd,sc); + } + + + sc = k.scan_code; + + writeit(fd,sc); // key down + + sc |= 0x80; // key up + + writeit(fd,sc); + + if (k.capital) { + sc = 0x2a | 0x80; + writeit(fd,sc); + } + } + + } 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; */ + + } + return 0; +} + +int main(int argc, char* argv[]) { + int vm_fd; + int cons_fd; + char * vm_dev = NULL; + struct termios termios; + + use_curses = 1; + + if (argc < 2) { + printf("Usage: ./v3_cons \n"); + return -1; + } + + vm_dev = argv[1]; + + + + vm_fd = open(vm_dev, O_RDONLY); + + if (vm_fd == -1) { + printf("Error opening VM device: %s\n", vm_dev); + return -1; + } + + cons_fd = ioctl(vm_fd, V3_VM_CONSOLE_CONNECT, NULL); + + /* Close the file descriptor. */ + close(vm_fd); + + if (cons_fd < 0) { + printf("Error opening stream Console\n"); + return -1; + } + + tcgetattr(STDIN_FILENO, &console.termios_old); + atexit(handle_exit); + + console.x = 0; + console.y = 0; + + + if (use_curses) { + gettmode(); + console.win = initscr(); + + if (console.win == NULL) { + fprintf(stderr, "Error initialization curses screen\n"); + exit(-1); + } + + scrollok(console.win, 1); + } + + /* + termios = console.termios_old; + termios.c_iflag &= ~(BRKINT | ICRNL | IGNBRK | IGNCR | IGNPAR); + termios.c_iflag &= ~(INLCR | INPCK | ISTRIP | IXOFF | IXON | PARMRK); + //termios.c_iflag &= ~(ICRNL | INLCR ); + + // termios.c_iflag |= SCANCODES; + // termios.c_lflag &= ~(ECHO | ECHOE | ECHOK | ECHONL); + //termios.c_lflag &= ~(ICANON | IEXTEN | ISIG | NOFLSH); + termios.c_lflag &= ~(ICANON | ECHO); + + termios.c_cc[VMIN] = 1; + termios.c_cc[VTIME] = 0; + + tcflush(STDIN_FILENO, TCIFLUSH); + tcsetattr(STDIN_FILENO, TCSANOW, &termios); + */ + + raw(); + cbreak(); + noecho(); + keypad(console.win, TRUE); + + //ioctl(STDIN_FILENO, KDSKBMODE, K_RAW); + + while (1) { + int ret; + int bytes_read = 0; + fd_set rset; + + FD_ZERO(&rset); + FD_SET(cons_fd, &rset); + FD_SET(STDIN_FILENO, &rset); + + ret = select(cons_fd + 1, &rset, NULL, NULL, NULL); + + // printf("Returned from select...\n"); + + if (ret == 0) { + continue; + } else if (ret == -1) { + perror("Select returned error...\n"); + return -1; + } + + if (FD_ISSET(cons_fd, &rset)) { + if (handle_console_msg(cons_fd) == -1) { + printf("Console Error\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 (send_char_to_palacios_as_scancodes(cons_fd,key)) { + fprintf(stderr, "Error sendign key to console\n"); + return -1; + } + } + + } + } + + close(cons_fd); + + return 0; +} + +