Subversion Repositories HelenOS-historic

Rev

Rev 1526 | Rev 1533 | 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. connection_t connections[CONSOLE_COUNT];    /**< Array of data for virtual consoles */
  73. keyfield_t *interbuffer = NULL;         /**< Pointer to memory shared with framebufer used for faster virt. console switching */
  74.  
  75.  
  76. /** Find unused virtual console.
  77.  *
  78.  */
  79. static int find_free_connection()
  80. {
  81.     int i = 0;
  82.    
  83.     while (i < CONSOLE_COUNT) {
  84.         if (connections[i].used == 0)
  85.             return i;
  86.         ++i;
  87.     }
  88.     return CONSOLE_COUNT;
  89. }
  90.  
  91. /** Find index of virtual console used by client with given phone.
  92.  *
  93.  */
  94. static int find_connection(int client_phone)
  95. {
  96.     int i = 0;
  97.    
  98.     while (i < CONSOLE_COUNT) {
  99.         if (connections[i].client_phone == client_phone)
  100.             return i;
  101.         ++i;
  102.     }
  103.     return  CONSOLE_COUNT;
  104. }
  105.  
  106. /** Check key and process special keys.
  107.  *
  108.  * */
  109. static void write_char(int console, char key)
  110. {
  111.     screenbuffer_t *scr = &(connections[console].screenbuffer);
  112.    
  113.     switch (key) {
  114.         case '\n':
  115.             scr->position_y += 1;
  116.             scr->position_x =  0;
  117.             break;
  118.         case '\r':
  119.             break;
  120.         case '\t':
  121.             scr->position_x += 8;
  122.             scr->position_x -= scr->position_x % 8;
  123.             break;
  124.         case '\b':
  125.             if (scr->position_x == 0)
  126.                 break;
  127.  
  128.             scr->position_x--;
  129.  
  130.             if (console == active_console) {
  131.                 nsend_call_3(fb_info.phone, FB_PUTCHAR, ' ', scr->position_y, scr->position_x);
  132.             }
  133.    
  134.             screenbuffer_putchar(scr, ' ');
  135.            
  136.             break;
  137.         default:   
  138.             if (console == active_console) {
  139.                 nsend_call_3(fb_info.phone, FB_PUTCHAR, key, scr->position_y, scr->position_x);
  140.             }
  141.    
  142.             screenbuffer_putchar(scr, key);
  143.             scr->position_x++;
  144.     }
  145.    
  146.     scr->position_y += (scr->position_x >= scr->size_x);
  147.    
  148.     if (scr->position_y >= scr->size_y) {
  149.         scr->position_y = scr->size_y - 1;
  150.         screenbuffer_clear_line(scr, scr->top_line++);
  151.         if (console == active_console)
  152.             nsend_call(fb_info.phone, FB_SCROLL, 1);
  153.     }
  154.    
  155.     scr->position_x = scr->position_x % scr->size_x;
  156.    
  157.     if (console == active_console) 
  158.         send_call_2(fb_info.phone, FB_CURSOR_GOTO, scr->position_y, scr->position_x);
  159.    
  160. }
  161.  
  162.  
  163. /** Handler for keyboard */
  164. static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
  165. {
  166.     ipc_callid_t callid;
  167.     ipc_call_t call;
  168.     int retval;
  169.     int i, j;
  170.     char c,d;
  171.     connection_t *conn;
  172.    
  173.     /* Ignore parameters, the connection is alread opened */
  174.     while (1) {
  175.         callid = async_get_call(&call);
  176.         switch (IPC_GET_METHOD(call)) {
  177.         case IPC_M_PHONE_HUNGUP:
  178.             ipc_answer_fast(callid,0,0,0);
  179.             /* TODO: Handle hangup */
  180.             return;
  181.         case KBD_PUSHCHAR:
  182.             /* got key from keyboard driver */
  183.            
  184.             retval = 0;
  185.             c = IPC_GET_ARG1(call);
  186.             /* switch to another virtual console */
  187.            
  188.             conn = &connections[active_console];
  189. //          if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) {
  190.             if ((c >= '0') && (c < '0' + CONSOLE_COUNT)) {
  191.                 if (c == '0') {
  192.                     /* switch to kernel console*/
  193.                     nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 0);
  194.                     nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR);
  195.                     nsend_call(fb_info.phone, FB_CLEAR, 0);
  196.                     /* FIXME: restore kernel console */
  197.                      __SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
  198.                      break;
  199.                      
  200.                 } else {
  201.                     c = c - '1';
  202.                     if (c == active_console)
  203.                         break;
  204.                     active_console = c;
  205.                     gcons_change_console(c);
  206.                
  207.                 }
  208.                
  209.                 conn = &connections[active_console];
  210.  
  211.                 nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 0);
  212.        
  213.                 if (interbuffer) {
  214.                     for (i = 0; i < conn->screenbuffer.size_x; i++)
  215.                         for (j = 0; j < conn->screenbuffer.size_y; j++)
  216.                             interbuffer[i + j*conn->screenbuffer.size_x] = *get_field_at(&(conn->screenbuffer),i, j);
  217.                            
  218.                     sync_send_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL);       
  219.                 } else {
  220.                     nsend_call(fb_info.phone, FB_CLEAR, 0);
  221.                
  222.                    
  223.                     for (i = 0; i < conn->screenbuffer.size_x; i++)
  224.                         for (j = 0; j < conn->screenbuffer.size_y; j++) {
  225.                             d = get_field_at(&(conn->screenbuffer),i, j)->character;
  226.                             if (d && d != ' ')
  227.                                 nsend_call_3(fb_info.phone, FB_PUTCHAR, d, j, i);
  228.                         }
  229.  
  230.                 }
  231.                 nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, conn->screenbuffer.position_y, conn->screenbuffer.position_x);
  232.                 nsend_call_2(fb_info.phone, FB_SET_STYLE, conn->screenbuffer.style.fg_color, \
  233.                         conn->screenbuffer.style.bg_color);
  234.                 send_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);
  235.  
  236.                 break;
  237.             }
  238.            
  239.             /* if client is awaiting key, send it */
  240.             if (conn->keyrequest_counter > 0) {    
  241.                 conn->keyrequest_counter--;
  242.                 ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0);
  243.                 break;
  244.             }
  245.            
  246.             /*FIXME: else store key to its buffer */
  247.             keybuffer_push(&conn->keybuffer, c);
  248.            
  249.             break;
  250.         default:
  251.             retval = ENOENT;
  252.         }      
  253.         ipc_answer_fast(callid, retval, 0, 0);
  254.     }
  255. }
  256.  
  257. /** Default thread for new connections */
  258. static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
  259. {
  260.     ipc_callid_t callid;
  261.     ipc_call_t call;
  262.     int consnum;
  263.     ipcarg_t arg1, arg2;
  264.  
  265.     if ((consnum = find_free_connection()) == CONSOLE_COUNT) {
  266.         ipc_answer_fast(iid,ELIMIT,0,0);
  267.         return;
  268.     }
  269.  
  270.     connections[consnum].used = 1;
  271.     connections[consnum].client_phone = IPC_GET_ARG3(call);
  272.     screenbuffer_clear(&(connections[consnum].screenbuffer));
  273.    
  274.     /* Accept the connection */
  275.     ipc_answer_fast(iid,0,0,0);
  276.    
  277.     while (1) {
  278.         callid = async_get_call(&call);
  279.         arg1 = arg2 = 0;
  280.         switch (IPC_GET_METHOD(call)) {
  281.         case IPC_M_PHONE_HUNGUP:
  282.             /* TODO */
  283.             ipc_answer_fast(callid, 0,0,0);
  284.             return;
  285.         case CONSOLE_PUTCHAR:
  286.             write_char(consnum, IPC_GET_ARG1(call));
  287.             gcons_notify_char(consnum);
  288.             break;
  289.         case CONSOLE_CLEAR:
  290.             /* Send message to fb */
  291.             if (consnum == active_console) {
  292.                 send_call(fb_info.phone, FB_CLEAR, 0);
  293.             }
  294.            
  295.             screenbuffer_clear(&(connections[consnum].screenbuffer));
  296.            
  297.             break;
  298.         case CONSOLE_GOTO:
  299.            
  300.             screenbuffer_goto(&(connections[consnum].screenbuffer), IPC_GET_ARG2(call), IPC_GET_ARG1(call));
  301.            
  302.             break;
  303.  
  304.         case CONSOLE_GETSIZE:
  305.             arg1 = fb_info.rows;
  306.             arg2 = fb_info.cols;
  307.             break;
  308.         case CONSOLE_FLUSH:
  309.             sync_send_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL);    
  310.             break;
  311.         case CONSOLE_SET_STYLE:
  312.            
  313.             arg1 = IPC_GET_ARG1(call);
  314.             arg2 = IPC_GET_ARG2(call);
  315.             screenbuffer_set_style(&(connections[consnum]),arg1, arg2);
  316.             if (consnum == active_console)
  317.                 nsend_call_2(fb_info.phone, FB_SET_STYLE, arg1, arg2);
  318.                
  319.             break;
  320.         case CONSOLE_GETCHAR:
  321.             if (keybuffer_empty(&(connections[consnum].keybuffer))) {
  322.                 /* buffer is empty -> store request */
  323.                 if (connections[consnum].keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) {      
  324.                     fifo_push(connections[consnum].keyrequests, callid);
  325.                     connections[consnum].keyrequest_counter++;
  326.                 } else {
  327.                     /* no key available and too many requests => fail */
  328.                     ipc_answer_fast(callid, ELIMIT, 0, 0);
  329.                 }
  330.                 continue;
  331.             };
  332.             keybuffer_pop(&(connections[consnum].keybuffer), (char *)&arg1);
  333.            
  334.             break;
  335.         }
  336.         ipc_answer_fast(callid, 0, arg1, arg2);
  337.     }
  338. }
  339.  
  340. int main(int argc, char *argv[])
  341. {
  342.     ipcarg_t phonehash;
  343.     int kbd_phone, fb_phone;
  344.     ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef;
  345.     int i;
  346.  
  347.     async_set_client_connection(client_connection);
  348.    
  349.     /* Connect to keyboard driver */
  350.  
  351.     while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {
  352.         usleep(10000);
  353.     };
  354.    
  355.     if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) {
  356.         return -1;
  357.     };
  358.  
  359.     /* Connect to framebuffer driver */
  360.    
  361.     while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {
  362.         usleep(10000);
  363.     }
  364.  
  365.     /* Initialize gcons */
  366.     gcons_init(fb_info.phone);
  367.     /* Synchronize, the gcons can have something in queue */
  368.     sync_send_2(fb_info.phone, FB_GET_CSIZE, 0, 0, NULL, NULL);
  369.  
  370.    
  371.     ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));
  372.     nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR);
  373.     nsend_call(fb_info.phone, FB_CLEAR, 0);
  374.    
  375.     /* Init virtual consoles */
  376.     for (i = 0; i < CONSOLE_COUNT; i++) {
  377.         connections[i].used = 0;
  378.         keybuffer_init(&(connections[i].keybuffer));
  379.        
  380.         connections[i].keyrequests.head = connections[i].keyrequests.tail = 0;
  381.         connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED;
  382.         connections[i].keyrequest_counter = 0;
  383.        
  384.         if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) {
  385.             /*FIXME: handle error */
  386.             return -1;
  387.         }
  388.     }
  389.    
  390.     if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ|PROTO_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, 0 ,0 )) != NULL) {
  391.         if (ipc_call_sync_3(fb_info.phone, IPC_M_AS_AREA_SEND, (ipcarg_t)interbuffer, 0, AS_AREA_READ | AS_AREA_CACHEABLE, NULL, NULL, NULL) != 0) {
  392.             munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);
  393.             interbuffer = NULL;
  394.         }
  395.     }
  396.  
  397.     /* FIXME: save kernel console screen */
  398.    
  399.     async_new_connection(phonehash, 0, NULL, keyboard_events);
  400.    
  401.     sync_send_2(fb_info.phone, FB_CURSOR_GOTO, 0, 0, NULL, NULL);
  402.     nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);
  403.  
  404.     /* Register at NS */
  405.     if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) {
  406.         return -1;
  407.     };
  408.    
  409.     async_manager();
  410.  
  411.     return 0;  
  412. }
  413.  
  414.