Subversion Repositories HelenOS

Rev

Rev 1574 | Rev 1578 | 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.     char c;
  209.  
  210.     if (newcons == active_console)
  211.         return;
  212.  
  213.     if (newcons == KERNEL_CONSOLE) {
  214.         if (active_console == KERNEL_CONSOLE)
  215.             return;
  216.         active_console = KERNEL_CONSOLE;
  217.         curs_visibility(0);
  218.  
  219.         if (kernel_pixmap == -1) {
  220.             /* store/restore unsupported */
  221.             set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
  222.             clrscr();
  223.         } else {
  224.             gcons_in_kernel();
  225.             console_pixmap = switch_screens(kernel_pixmap);
  226.             kernel_pixmap = -1;
  227.         }
  228.  
  229.         __SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
  230.         return;
  231.     }
  232.    
  233.     if (console_pixmap != -1) {
  234.         kernel_pixmap = switch_screens(console_pixmap);
  235.         console_pixmap = -1;
  236.     }
  237.    
  238.     active_console = newcons;
  239.     gcons_change_console(newcons);
  240.     conn = &connections[active_console];
  241.  
  242.     set_style(&conn->screenbuffer.style);
  243.     curs_goto(conn->screenbuffer.position_y, conn->screenbuffer.position_x);
  244.     if (interbuffer) {
  245.         for (i = 0; i < conn->screenbuffer.size_x; i++)
  246.             for (j = 0; j < conn->screenbuffer.size_y; j++)
  247.                 interbuffer[i + j*conn->screenbuffer.size_x] = *get_field_at(&(conn->screenbuffer),i, j);
  248.         /* This call can preempt, but we are already at the end */
  249.         sync_send_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL);       
  250.         curs_visibility(conn->screenbuffer.is_cursor_visible);
  251.     } else {
  252.         clrscr();
  253.        
  254.         for (i = 0; i < conn->screenbuffer.size_x; i++)
  255.             for (j = 0; j < conn->screenbuffer.size_y; j++) {
  256.                 c = get_field_at(&(conn->screenbuffer),i, j)->character;
  257.                 if (c && c != ' ')
  258.                     prtchr(c, j, i);
  259.             }
  260.        
  261.         curs_visibility(conn->screenbuffer.is_cursor_visible);
  262.     }
  263. }
  264.  
  265. /** Handler for keyboard */
  266. static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
  267. {
  268.     ipc_callid_t callid;
  269.     ipc_call_t call;
  270.     int retval;
  271.     int c;
  272.     connection_t *conn;
  273.    
  274.     /* Ignore parameters, the connection is alread opened */
  275.     while (1) {
  276.         callid = async_get_call(&call);
  277.         switch (IPC_GET_METHOD(call)) {
  278.         case IPC_M_PHONE_HUNGUP:
  279.             ipc_answer_fast(callid,0,0,0);
  280.             /* TODO: Handle hangup */
  281.             return;
  282.         case KBD_PUSHCHAR:
  283.             /* got key from keyboard driver */
  284.            
  285.             retval = 0;
  286.             c = IPC_GET_ARG1(call);
  287.             /* switch to another virtual console */
  288.            
  289.             conn = &connections[active_console];
  290. //          if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) {
  291.             if ((c >= 0x101) && (c < 0x101 + CONSOLE_COUNT)) {
  292.                 if (c == 0x112)
  293.                     change_console(KERNEL_CONSOLE);
  294.                 else
  295.                     change_console(c - 0x101);
  296.                 break;
  297.             }
  298.            
  299.             /* if client is awaiting key, send it */
  300.             if (conn->keyrequest_counter > 0) {    
  301.                 conn->keyrequest_counter--;
  302.                 ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0);
  303.                 break;
  304.             }
  305.            
  306.             /*FIXME: else store key to its buffer */
  307.             keybuffer_push(&conn->keybuffer, c);
  308.            
  309.             break;
  310.         default:
  311.             retval = ENOENT;
  312.         }      
  313.         ipc_answer_fast(callid, retval, 0, 0);
  314.     }
  315. }
  316.  
  317. /** Default thread for new connections */
  318. static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
  319. {
  320.     ipc_callid_t callid;
  321.     ipc_call_t call;
  322.     int consnum;
  323.     ipcarg_t arg1, arg2;
  324.  
  325.     if ((consnum = find_free_connection()) == -1) {
  326.         ipc_answer_fast(iid,ELIMIT,0,0);
  327.         return;
  328.     }
  329.    
  330.     gcons_notify_connect(consnum);
  331.     connections[consnum].used = 1;
  332.     connections[consnum].client_phone = IPC_GET_ARG3(call);
  333.     screenbuffer_clear(&(connections[consnum].screenbuffer));
  334.    
  335.     /* Accept the connection */
  336.     ipc_answer_fast(iid,0,0,0);
  337.    
  338.     while (1) {
  339.         callid = async_get_call(&call);
  340.         arg1 = arg2 = 0;
  341.         switch (IPC_GET_METHOD(call)) {
  342.         case IPC_M_PHONE_HUNGUP:
  343.             /* TODO */
  344.             ipc_answer_fast(callid, 0,0,0);
  345.             return;
  346.         case CONSOLE_PUTCHAR:
  347.             write_char(consnum, IPC_GET_ARG1(call));
  348.             gcons_notify_char(consnum);
  349.             break;
  350.         case CONSOLE_CLEAR:
  351.             /* Send message to fb */
  352.             if (consnum == active_console) {
  353.                 send_call(fb_info.phone, FB_CLEAR, 0);
  354.             }
  355.            
  356.             screenbuffer_clear(&(connections[consnum].screenbuffer));
  357.            
  358.             break;
  359.         case CONSOLE_GOTO:
  360.            
  361.             screenbuffer_goto(&(connections[consnum].screenbuffer), IPC_GET_ARG2(call), IPC_GET_ARG1(call));
  362.             if (consnum == active_console)
  363.                 curs_goto(IPC_GET_ARG1(call),IPC_GET_ARG2(call));
  364.            
  365.             break;
  366.  
  367.         case CONSOLE_GETSIZE:
  368.             arg1 = fb_info.rows;
  369.             arg2 = fb_info.cols;
  370.             break;
  371.         case CONSOLE_FLUSH:
  372.             sync_send_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL);    
  373.             break;
  374.         case CONSOLE_SET_STYLE:
  375.            
  376.             arg1 = IPC_GET_ARG1(call);
  377.             arg2 = IPC_GET_ARG2(call);
  378.             screenbuffer_set_style(&(connections[consnum].screenbuffer),arg1, arg2);
  379.             if (consnum == active_console)
  380.                 set_style_col(arg1, arg2);
  381.                
  382.             break;
  383.         case CONSOLE_CURSOR_VISIBILITY:
  384.             arg1 = IPC_GET_ARG1(call);
  385.             connections[consnum].screenbuffer.is_cursor_visible = arg1;
  386.             if (consnum == active_console)
  387.                 curs_visibility(arg1);
  388.             break;
  389.         case CONSOLE_GETCHAR:
  390.             if (keybuffer_empty(&(connections[consnum].keybuffer))) {
  391.                 /* buffer is empty -> store request */
  392.                 if (connections[consnum].keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) {      
  393.                     fifo_push(connections[consnum].keyrequests, callid);
  394.                     connections[consnum].keyrequest_counter++;
  395.                 } else {
  396.                     /* no key available and too many requests => fail */
  397.                     ipc_answer_fast(callid, ELIMIT, 0, 0);
  398.                 }
  399.                 continue;
  400.             };
  401.             keybuffer_pop(&(connections[consnum].keybuffer), (int *)&arg1);
  402.            
  403.             break;
  404.         }
  405.         ipc_answer_fast(callid, 0, arg1, arg2);
  406.     }
  407. }
  408.  
  409. int main(int argc, char *argv[])
  410. {
  411.     ipcarg_t phonehash;
  412.     int kbd_phone, fb_phone;
  413.     ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef;
  414.     int i;
  415.  
  416.     async_set_client_connection(client_connection);
  417.    
  418.     /* Connect to keyboard driver */
  419.  
  420.     while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {
  421.         usleep(10000);
  422.     };
  423.    
  424.     if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) {
  425.         return -1;
  426.     };
  427.  
  428.     /* Connect to framebuffer driver */
  429.    
  430.     while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {
  431.         usleep(10000);
  432.     }
  433.    
  434.     /* Save old kernel screen */
  435.     kernel_pixmap = switch_screens(-1);
  436.  
  437.     /* Initialize gcons */
  438.     gcons_init(fb_info.phone);
  439.     /* Synchronize, the gcons can have something in queue */
  440.     sync_send(fb_info.phone, FB_FLUSH, 0, NULL);
  441.  
  442.    
  443.     ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));
  444.     set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
  445.     clrscr();
  446.    
  447.     /* Init virtual consoles */
  448.     for (i = 0; i < CONSOLE_COUNT; i++) {
  449.         connections[i].used = 0;
  450.         keybuffer_init(&(connections[i].keybuffer));
  451.        
  452.         connections[i].keyrequests.head = connections[i].keyrequests.tail = 0;
  453.         connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED;
  454.         connections[i].keyrequest_counter = 0;
  455.        
  456.         if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) {
  457.             /*FIXME: handle error */
  458.             return -1;
  459.         }
  460.     }
  461.     connections[KERNEL_CONSOLE].used = 1;
  462.    
  463.     if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ|PROTO_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, 0 ,0 )) != NULL) {
  464.         if (ipc_call_sync_3(fb_info.phone, IPC_M_AS_AREA_SEND, (ipcarg_t)interbuffer, 0, AS_AREA_READ, NULL, NULL, NULL) != 0) {
  465.             munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);
  466.             interbuffer = NULL;
  467.         }
  468.     }
  469.  
  470.     async_new_connection(phonehash, 0, NULL, keyboard_events);
  471.    
  472.     curs_goto(0,0);
  473.     curs_visibility(connections[active_console].screenbuffer.is_cursor_visible);
  474.  
  475.     /* Register at NS */
  476.     if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) {
  477.         return -1;
  478.     };
  479.    
  480.     async_manager();
  481.  
  482.     return 0;  
  483. }
  484.  
  485.