Subversion Repositories HelenOS-historic

Rev

Rev 1578 | Rev 1616 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright (C) 2006 Josef Cejka
  3.  * All rights reserved.
  4.  *
  5.  * Redistribution and use in source and binary forms, with or without
  6.  * modification, are permitted provided that the following conditions
  7.  * are met:
  8.  *
  9.  * - Redistributions of source code must retain the above copyright
  10.  *   notice, this list of conditions and the following disclaimer.
  11.  * - Redistributions in binary form must reproduce the above copyright
  12.  *   notice, this list of conditions and the following disclaimer in the
  13.  *   documentation and/or other materials provided with the distribution.
  14.  * - The name of the author may not be used to endorse or promote products
  15.  *   derived from this software without specific prior written permission.
  16.  *
  17.  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  18.  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  19.  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  20.  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  21.  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  22.  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  23.  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  24.  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  25.  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  26.  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  27.  */
  28.  
  29.  
  30. #include <kbd.h>
  31. #include <fb.h>
  32. #include <ipc/ipc.h>
  33. #include <ipc/fb.h>
  34. #include <ipc/services.h>
  35. #include <errno.h>
  36. #include <key_buffer.h>
  37. #include <console.h>
  38. #include <unistd.h>
  39. #include <async.h>
  40. #include <libadt/fifo.h>
  41. #include <screenbuffer.h>
  42. #include <sys/mman.h>
  43.  
  44. #include "gcons.h"
  45.  
  46. #define MAX_KEYREQUESTS_BUFFERED 32
  47.  
  48. #define NAME "CONSOLE"
  49.  
  50. /** Index of currently used virtual console.
  51.  */
  52. int active_console = 0;
  53.  
  54. /** Information about framebuffer
  55.  */
  56. struct {
  57.     int phone;      /**< Framebuffer phone */
  58.     ipcarg_t rows;      /**< Framebuffer rows */
  59.     ipcarg_t cols;      /**< Framebuffer columns */
  60. } fb_info;
  61.  
  62.  
  63. typedef struct {
  64.     keybuffer_t keybuffer;      /**< Buffer for incoming keys. */
  65.     FIFO_CREATE_STATIC(keyrequests, ipc_callid_t , MAX_KEYREQUESTS_BUFFERED);   /**< Buffer for unsatisfied request for keys. */
  66.     int keyrequest_counter;     /**< Number of requests in buffer. */
  67.     int client_phone;       /**< Phone to connected client. */
  68.     int used;           /**< 1 if this virtual console is connected to some client.*/
  69.     screenbuffer_t screenbuffer;    /**< Screenbuffer for saving screen contents and related settings. */
  70. } connection_t;
  71.  
  72. static connection_t connections[CONSOLE_COUNT]; /**< Array of data for virtual consoles */
  73. static keyfield_t *interbuffer = NULL;          /**< Pointer to memory shared with framebufer used for faster virt. console switching */
  74.  
  75. static int kernel_pixmap = -1;      /**< Number of fb pixmap, where kernel console is stored */
  76.  
  77.  
  78. /** Find unused virtual console.
  79.  *
  80.  */
  81. static int find_free_connection(void)
  82. {
  83.     int i = 0;
  84.    
  85.     for (i=0; i < CONSOLE_COUNT; i++) {
  86.         if (!connections[i].used)
  87.             return i;
  88.     }
  89.     return -1;
  90. }
  91.  
  92. static void clrscr(void)
  93. {
  94.     nsend_call(fb_info.phone, FB_CLEAR, 0);
  95. }
  96.  
  97. static void curs_visibility(int v)
  98. {
  99.     send_call(fb_info.phone, FB_CURSOR_VISIBILITY, v);
  100. }
  101.  
  102. static void curs_goto(int row, int col)
  103. {
  104.     nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, row, col);
  105.    
  106. }
  107.  
  108. static void set_style(style_t *style)
  109. {
  110.     nsend_call_2(fb_info.phone, FB_SET_STYLE, style->fg_color, style->bg_color);
  111. }
  112.  
  113. static void set_style_col(int fgcolor, int bgcolor)
  114. {
  115.     nsend_call_2(fb_info.phone, FB_SET_STYLE, fgcolor, bgcolor);
  116. }
  117.  
  118. static void prtchr(char c, int row, int col)
  119. {
  120.     nsend_call_3(fb_info.phone, FB_PUTCHAR, c, row, col);
  121.    
  122. }
  123.  
  124. /** Check key and process special keys.
  125.  *
  126.  * */
  127. static void write_char(int console, char key)
  128. {
  129.     screenbuffer_t *scr = &(connections[console].screenbuffer);
  130.    
  131.     switch (key) {
  132.         case '\n':
  133.             scr->position_y += 1;
  134.             scr->position_x =  0;
  135.             break;
  136.         case '\r':
  137.             break;
  138.         case '\t':
  139.             scr->position_x += 8;
  140.             scr->position_x -= scr->position_x % 8;
  141.             break;
  142.         case '\b':
  143.             if (scr->position_x == 0)
  144.                 break;
  145.  
  146.             scr->position_x--;
  147.  
  148.             if (console == active_console)
  149.                 prtchr(' ', scr->position_y, scr->position_x);
  150.    
  151.             screenbuffer_putchar(scr, ' ');
  152.            
  153.             break;
  154.         default:   
  155.             if (console == active_console)
  156.                 prtchr(key, scr->position_y, scr->position_x);
  157.    
  158.             screenbuffer_putchar(scr, key);
  159.             scr->position_x++;
  160.     }
  161.    
  162.     scr->position_y += (scr->position_x >= scr->size_x);
  163.    
  164.     if (scr->position_y >= scr->size_y) {
  165.         scr->position_y = scr->size_y - 1;
  166.         screenbuffer_clear_line(scr, scr->top_line++);
  167.         if (console == active_console)
  168.             nsend_call(fb_info.phone, FB_SCROLL, 1);
  169.     }
  170.    
  171.     scr->position_x = scr->position_x % scr->size_x;
  172.    
  173.     if (console == active_console)
  174.         curs_goto(scr->position_y, scr->position_x);
  175.    
  176. }
  177.  
  178. /** Save current screen to pixmap, draw old pixmap
  179.  *
  180.  * @param oldpixmap Old pixmap
  181.  * @return ID of pixmap of current screen
  182.  */
  183. static int switch_screens(int oldpixmap)
  184. {
  185.     int newpmap;
  186.        
  187.     /* Save screen */
  188.     newpmap = sync_send(fb_info.phone, FB_VP2PIXMAP, 0, NULL);
  189.     if (newpmap < 0)
  190.         return -1;
  191.  
  192.     if (oldpixmap != -1) {
  193.         /* Show old screen */
  194.         nsend_call_2(fb_info.phone, FB_VP_DRAW_PIXMAP, 0, oldpixmap);
  195.         /* Drop old pixmap */
  196.         nsend_call(fb_info.phone, FB_DROP_PIXMAP, oldpixmap);
  197.     }
  198.    
  199.     return newpmap;
  200. }
  201.  
  202. /** Switch to new console */
  203. static void change_console(int newcons)
  204. {
  205.     connection_t *conn;
  206.     static int console_pixmap = -1;
  207.     int i, j;
  208.     keyfield_t *field;
  209.     style_t *style;
  210.     char c;
  211.  
  212.     if (newcons == active_console)
  213.         return;
  214.  
  215.     if (newcons == KERNEL_CONSOLE) {
  216.         if (active_console == KERNEL_CONSOLE)
  217.             return;
  218.         active_console = KERNEL_CONSOLE;
  219.         curs_visibility(0);
  220.  
  221.         if (kernel_pixmap == -1) {
  222.             /* store/restore unsupported */
  223.             set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
  224.             clrscr();
  225.         } else {
  226.             gcons_in_kernel();
  227.             console_pixmap = switch_screens(kernel_pixmap);
  228.             kernel_pixmap = -1;
  229.         }
  230.  
  231.         __SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
  232.         return;
  233.     }
  234.    
  235.     if (console_pixmap != -1) {
  236.         kernel_pixmap = switch_screens(console_pixmap);
  237.         console_pixmap = -1;
  238.     }
  239.    
  240.     active_console = newcons;
  241.     gcons_change_console(newcons);
  242.     conn = &connections[active_console];
  243.  
  244.     set_style(&conn->screenbuffer.style);
  245.     curs_goto(conn->screenbuffer.position_y, conn->screenbuffer.position_x);
  246.     curs_visibility(0);
  247.    
  248.     if (interbuffer) {
  249.         for (i = 0; i < conn->screenbuffer.size_x; i++)
  250.             for (j = 0; j < conn->screenbuffer.size_y; j++)
  251.                 interbuffer[i + j*conn->screenbuffer.size_x] = *get_field_at(&(conn->screenbuffer),i, j);
  252.         /* This call can preempt, but we are already at the end */
  253.         j = sync_send_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL);       
  254.     };
  255.    
  256.     if ((!interbuffer) || (j != 0)){
  257.         set_style(&conn->screenbuffer.style);
  258.         clrscr();
  259.         style = &conn->screenbuffer.style;
  260.  
  261.         for (j = 0; j < conn->screenbuffer.size_y; j++)
  262.             for (i = 0; i < conn->screenbuffer.size_x; i++) {
  263.                 field = get_field_at(&(conn->screenbuffer),i, j);
  264.                 if (!style_same(*style, field->style))
  265.                     set_style(&field->style);
  266.                 style = &field->style;
  267.                 if ((field->character == ' ') && (style_same(field->style, conn->screenbuffer.style)))
  268.                     continue;
  269.  
  270.                 prtchr(field->character, j, i);
  271.             }
  272.     }
  273.    
  274.     curs_visibility(conn->screenbuffer.is_cursor_visible);
  275. }
  276.  
  277. /** Handler for keyboard */
  278. static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
  279. {
  280.     ipc_callid_t callid;
  281.     ipc_call_t call;
  282.     int retval;
  283.     int c;
  284.     connection_t *conn;
  285.    
  286.     /* Ignore parameters, the connection is alread opened */
  287.     while (1) {
  288.         callid = async_get_call(&call);
  289.         switch (IPC_GET_METHOD(call)) {
  290.         case IPC_M_PHONE_HUNGUP:
  291.             ipc_answer_fast(callid,0,0,0);
  292.             /* TODO: Handle hangup */
  293.             return;
  294.         case KBD_PUSHCHAR:
  295.             /* got key from keyboard driver */
  296.            
  297.             retval = 0;
  298.             c = IPC_GET_ARG1(call);
  299.             /* switch to another virtual console */
  300.            
  301.             conn = &connections[active_console];
  302. //          if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) {
  303.             if ((c >= 0x101) && (c < 0x101 + CONSOLE_COUNT)) {
  304.                 if (c == 0x112)
  305.                     change_console(KERNEL_CONSOLE);
  306.                 else
  307.                     change_console(c - 0x101);
  308.                 break;
  309.             }
  310.            
  311.             /* if client is awaiting key, send it */
  312.             if (conn->keyrequest_counter > 0) {    
  313.                 conn->keyrequest_counter--;
  314.                 ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0);
  315.                 break;
  316.             }
  317.            
  318.             /*FIXME: else store key to its buffer */
  319.             keybuffer_push(&conn->keybuffer, c);
  320.            
  321.             break;
  322.         default:
  323.             retval = ENOENT;
  324.         }      
  325.         ipc_answer_fast(callid, retval, 0, 0);
  326.     }
  327. }
  328.  
  329. /** Default thread for new connections */
  330. static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
  331. {
  332.     ipc_callid_t callid;
  333.     ipc_call_t call;
  334.     int consnum;
  335.     ipcarg_t arg1, arg2;
  336.     connection_t *conn;
  337.  
  338.     if ((consnum = find_free_connection()) == -1) {
  339.         ipc_answer_fast(iid,ELIMIT,0,0);
  340.         return;
  341.     }
  342.     conn = &connections[consnum];
  343.    
  344.     gcons_notify_connect(consnum);
  345.     conn->used = 1;
  346.     conn->client_phone = IPC_GET_ARG3(call);
  347.     screenbuffer_clear(&conn->screenbuffer);
  348.    
  349.     /* Accept the connection */
  350.     ipc_answer_fast(iid,0,0,0);
  351.    
  352.     while (1) {
  353.         callid = async_get_call(&call);
  354.         arg1 = arg2 = 0;
  355.         switch (IPC_GET_METHOD(call)) {
  356.         case IPC_M_PHONE_HUNGUP:
  357.             gcons_notify_disconnect(consnum);
  358.             /* Answer all pending requests */
  359.             while (conn->keyrequest_counter > 0) {     
  360.                 conn->keyrequest_counter--;
  361.                 ipc_answer_fast(fifo_pop(conn->keyrequests), ENOENT, 0, 0);
  362.                 break;
  363.             }
  364.            
  365.             /* Commit hangup */
  366.             ipc_answer_fast(callid, 0,0,0);
  367.             return;
  368.         case CONSOLE_PUTCHAR:
  369.             write_char(consnum, IPC_GET_ARG1(call));
  370.             gcons_notify_char(consnum);
  371.             break;
  372.         case CONSOLE_CLEAR:
  373.             /* Send message to fb */
  374.             if (consnum == active_console) {
  375.                 send_call(fb_info.phone, FB_CLEAR, 0);
  376.             }
  377.            
  378.             screenbuffer_clear(&conn->screenbuffer);
  379.            
  380.             break;
  381.         case CONSOLE_GOTO:
  382.            
  383.             screenbuffer_goto(&conn->screenbuffer, IPC_GET_ARG2(call), IPC_GET_ARG1(call));
  384.             if (consnum == active_console)
  385.                 curs_goto(IPC_GET_ARG1(call),IPC_GET_ARG2(call));
  386.            
  387.             break;
  388.  
  389.         case CONSOLE_GETSIZE:
  390.             arg1 = fb_info.rows;
  391.             arg2 = fb_info.cols;
  392.             break;
  393.         case CONSOLE_FLUSH:
  394.             sync_send_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL);    
  395.             break;
  396.         case CONSOLE_SET_STYLE:
  397.            
  398.             arg1 = IPC_GET_ARG1(call);
  399.             arg2 = IPC_GET_ARG2(call);
  400.             screenbuffer_set_style(&conn->screenbuffer,arg1, arg2);
  401.             if (consnum == active_console)
  402.                 set_style_col(arg1, arg2);
  403.                
  404.             break;
  405.         case CONSOLE_CURSOR_VISIBILITY:
  406.             arg1 = IPC_GET_ARG1(call);
  407.             conn->screenbuffer.is_cursor_visible = arg1;
  408.             if (consnum == active_console)
  409.                 curs_visibility(arg1);
  410.             break;
  411.         case CONSOLE_GETCHAR:
  412.             if (keybuffer_empty(&conn->keybuffer)) {
  413.                 /* buffer is empty -> store request */
  414.                 if (conn->keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) {     
  415.                     fifo_push(conn->keyrequests, callid);
  416.                     conn->keyrequest_counter++;
  417.                 } else {
  418.                     /* no key available and too many requests => fail */
  419.                     ipc_answer_fast(callid, ELIMIT, 0, 0);
  420.                 }
  421.                 continue;
  422.             };
  423.             keybuffer_pop(&conn->keybuffer, (int *)&arg1);
  424.            
  425.             break;
  426.         }
  427.         ipc_answer_fast(callid, 0, arg1, arg2);
  428.     }
  429. }
  430.  
  431. int main(int argc, char *argv[])
  432. {
  433.     ipcarg_t phonehash;
  434.     int kbd_phone, fb_phone;
  435.     ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef;
  436.     int i;
  437.  
  438.     async_set_client_connection(client_connection);
  439.    
  440.     /* Connect to keyboard driver */
  441.  
  442.     while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {
  443.         usleep(10000);
  444.     };
  445.    
  446.     if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) {
  447.         return -1;
  448.     };
  449.  
  450.     /* Connect to framebuffer driver */
  451.    
  452.     while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {
  453.         usleep(10000);
  454.     }
  455.    
  456.     /* Save old kernel screen */
  457.     kernel_pixmap = switch_screens(-1);
  458.  
  459.     /* Initialize gcons */
  460.     gcons_init(fb_info.phone);
  461.     /* Synchronize, the gcons can have something in queue */
  462.     sync_send(fb_info.phone, FB_FLUSH, 0, NULL);
  463.  
  464.    
  465.     ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));
  466.     set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
  467.     clrscr();
  468.    
  469.     /* Init virtual consoles */
  470.     for (i = 0; i < CONSOLE_COUNT; i++) {
  471.         connections[i].used = 0;
  472.         keybuffer_init(&(connections[i].keybuffer));
  473.        
  474.         connections[i].keyrequests.head = connections[i].keyrequests.tail = 0;
  475.         connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED;
  476.         connections[i].keyrequest_counter = 0;
  477.        
  478.         if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) {
  479.             /*FIXME: handle error */
  480.             return -1;
  481.         }
  482.     }
  483.     connections[KERNEL_CONSOLE].used = 1;
  484.    
  485.     if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ|PROTO_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, 0 ,0 )) != NULL) {
  486.         if (ipc_call_sync_3(fb_info.phone, IPC_M_AS_AREA_SEND, (ipcarg_t)interbuffer, 0, AS_AREA_READ, NULL, NULL, NULL) != 0) {
  487.             munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);
  488.             interbuffer = NULL;
  489.         }
  490.     }
  491.  
  492.     async_new_connection(phonehash, 0, NULL, keyboard_events);
  493.    
  494.     curs_goto(0,0);
  495.     curs_visibility(connections[active_console].screenbuffer.is_cursor_visible);
  496.  
  497.     /* Register at NS */
  498.     if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) {
  499.         return -1;
  500.     };
  501.    
  502.     async_manager();
  503.  
  504.     return 0;  
  505. }
  506.  
  507.