Subversion Repositories HelenOS-historic

Rev

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