Subversion Repositories HelenOS-historic

Rev

Rev 1592 | 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. /* TODO: remove */
  29. #include <stdio.h>
  30.  
  31.  
  32. #include <kbd.h>
  33. #include <fb.h>
  34. #include <ipc/ipc.h>
  35. #include <ipc/fb.h>
  36. #include <ipc/services.h>
  37. #include <errno.h>
  38. #include <key_buffer.h>
  39. #include <console.h>
  40. #include <unistd.h>
  41. #include <async.h>
  42. #include <libadt/fifo.h>
  43. #include <screenbuffer.h>
  44. #include <sys/mman.h>
  45.  
  46. #include "gcons.h"
  47.  
  48. #define MAX_KEYREQUESTS_BUFFERED 32
  49.  
  50. #define NAME "CONSOLE"
  51.  
  52. /** Index of currently used virtual console.
  53.  */
  54. int active_console = 0;
  55.  
  56. /** Information about framebuffer
  57.  */
  58. struct {
  59.     int phone;      /**< Framebuffer phone */
  60.     ipcarg_t rows;      /**< Framebuffer rows */
  61.     ipcarg_t cols;      /**< Framebuffer columns */
  62. } fb_info;
  63.  
  64.  
  65. typedef struct {
  66.     keybuffer_t keybuffer;      /**< Buffer for incoming keys. */
  67.     FIFO_CREATE_STATIC(keyrequests, ipc_callid_t , MAX_KEYREQUESTS_BUFFERED);   /**< Buffer for unsatisfied request for keys. */
  68.     int keyrequest_counter;     /**< Number of requests in buffer. */
  69.     int client_phone;       /**< Phone to connected client. */
  70.     int used;           /**< 1 if this virtual console is connected to some client.*/
  71.     screenbuffer_t screenbuffer;    /**< Screenbuffer for saving screen contents and related settings. */
  72. } connection_t;
  73.  
  74. static connection_t connections[CONSOLE_COUNT]; /**< Array of data for virtual consoles */
  75. static keyfield_t *interbuffer = NULL;          /**< Pointer to memory shared with framebufer used for faster virt. console switching */
  76.  
  77. static int kernel_pixmap = -1;      /**< Number of fb pixmap, where kernel console is stored */
  78.  
  79.  
  80. /** Find unused virtual console.
  81.  *
  82.  */
  83. static int find_free_connection(void)
  84. {
  85.     int i = 0;
  86.    
  87.     for (i=0; i < CONSOLE_COUNT; i++) {
  88.         if (!connections[i].used)
  89.             return i;
  90.     }
  91.     return -1;
  92. }
  93.  
  94. static void clrscr(void)
  95. {
  96.     async_msg(fb_info.phone, FB_CLEAR, 0);
  97. }
  98.  
  99. static void curs_visibility(int v)
  100. {
  101.     async_msg(fb_info.phone, FB_CURSOR_VISIBILITY, v);
  102. }
  103.  
  104. static void curs_goto(int row, int col)
  105. {
  106.     async_msg_2(fb_info.phone, FB_CURSOR_GOTO, row, col);
  107.    
  108. }
  109.  
  110. static void set_style(style_t *style)
  111. {
  112.     async_msg_2(fb_info.phone, FB_SET_STYLE, style->fg_color, style->bg_color);
  113. }
  114.  
  115. static void set_style_col(int fgcolor, int bgcolor)
  116. {
  117.     async_msg_2(fb_info.phone, FB_SET_STYLE, fgcolor, bgcolor);
  118. }
  119.  
  120. static void prtchr(char c, int row, int col)
  121. {
  122.     async_msg_3(fb_info.phone, FB_PUTCHAR, c, row, col);
  123.    
  124. }
  125.  
  126. /** Check key and process special keys.
  127.  *
  128.  * */
  129. static void write_char(int console, char key)
  130. {
  131.     screenbuffer_t *scr = &(connections[console].screenbuffer);
  132.    
  133.     switch (key) {
  134.         case '\n':
  135.             scr->position_y += 1;
  136.             scr->position_x =  0;
  137.             break;
  138.         case '\r':
  139.             break;
  140.         case '\t':
  141.             scr->position_x += 8;
  142.             scr->position_x -= scr->position_x % 8;
  143.             break;
  144.         case '\b':
  145.             if (scr->position_x == 0)
  146.                 break;
  147.  
  148.             scr->position_x--;
  149.  
  150.             if (console == active_console)
  151.                 prtchr(' ', scr->position_y, scr->position_x);
  152.    
  153.             screenbuffer_putchar(scr, ' ');
  154.            
  155.             break;
  156.         default:   
  157.             if (console == active_console)
  158.                 prtchr(key, scr->position_y, scr->position_x);
  159.    
  160.             screenbuffer_putchar(scr, key);
  161.             scr->position_x++;
  162.     }
  163.    
  164.     scr->position_y += (scr->position_x >= scr->size_x);
  165.    
  166.     if (scr->position_y >= scr->size_y) {
  167.         scr->position_y = scr->size_y - 1;
  168.         screenbuffer_clear_line(scr, scr->top_line++);
  169.         if (console == active_console)
  170.             async_msg(fb_info.phone, FB_SCROLL, 1);
  171.     }
  172.    
  173.     scr->position_x = scr->position_x % scr->size_x;
  174.    
  175.     if (console == active_console)
  176.         curs_goto(scr->position_y, scr->position_x);
  177.    
  178. }
  179.  
  180. /** Save current screen to pixmap, draw old pixmap
  181.  *
  182.  * @param oldpixmap Old pixmap
  183.  * @return ID of pixmap of current screen
  184.  */
  185. static int switch_screens(int oldpixmap)
  186. {
  187.     int newpmap;
  188.        
  189.     /* Save screen */
  190.     newpmap = async_req(fb_info.phone, FB_VP2PIXMAP, 0, NULL);
  191.     if (newpmap < 0)
  192.         return -1;
  193.  
  194.     if (oldpixmap != -1) {
  195.         /* Show old screen */
  196.         async_msg_2(fb_info.phone, FB_VP_DRAW_PIXMAP, 0, oldpixmap);
  197.         /* Drop old pixmap */
  198.         async_msg(fb_info.phone, FB_DROP_PIXMAP, oldpixmap);
  199.     }
  200.    
  201.     return newpmap;
  202. }
  203.  
  204. /** Switch to new console */
  205. static void change_console(int newcons)
  206. {
  207.     connection_t *conn;
  208.     static int console_pixmap = -1;
  209.     int i, j;
  210.     keyfield_t *field;
  211.     style_t *style;
  212.     char c;
  213.  
  214.     if (newcons == active_console)
  215.         return;
  216.  
  217.     if (newcons == KERNEL_CONSOLE) {
  218.         if (active_console == KERNEL_CONSOLE)
  219.             return;
  220.         active_console = KERNEL_CONSOLE;
  221.         curs_visibility(0);
  222.  
  223.         if (kernel_pixmap == -1) {
  224.             /* store/restore unsupported */
  225.             set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
  226.             clrscr();
  227.         } else {
  228.             gcons_in_kernel();
  229.             console_pixmap = switch_screens(kernel_pixmap);
  230.             kernel_pixmap = -1;
  231.         }
  232.  
  233.         __SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
  234.         return;
  235.     }
  236.    
  237.     if (console_pixmap != -1) {
  238.         kernel_pixmap = switch_screens(console_pixmap);
  239.         console_pixmap = -1;
  240.     }
  241.     active_console = newcons;
  242.     gcons_change_console(newcons);
  243.     conn = &connections[active_console];
  244.  
  245.     set_style(&conn->screenbuffer.style);
  246.     curs_goto(conn->screenbuffer.position_y, conn->screenbuffer.position_x);
  247.     curs_visibility(0);
  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 = async_req_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.                 async_serialize_start();
  305.                 if (c == 0x112)
  306.                     change_console(KERNEL_CONSOLE);
  307.                 else
  308.                     change_console(c - 0x101);
  309.                 async_serialize_end();
  310.                 break;
  311.             }
  312.            
  313.             /* if client is awaiting key, send it */
  314.             if (conn->keyrequest_counter > 0) {    
  315.                 conn->keyrequest_counter--;
  316.                 ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0);
  317.                 break;
  318.             }
  319.            
  320.             /*FIXME: else store key to its buffer */
  321.             keybuffer_push(&conn->keybuffer, c);
  322.            
  323.             break;
  324.         default:
  325.             retval = ENOENT;
  326.         }
  327.         ipc_answer_fast(callid, retval, 0, 0);
  328.     }
  329. }
  330.  
  331. /** Default thread for new connections */
  332. static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
  333. {
  334.     ipc_callid_t callid;
  335.     ipc_call_t call;
  336.     int consnum;
  337.     ipcarg_t arg1, arg2;
  338.     connection_t *conn;
  339.  
  340.     if ((consnum = find_free_connection()) == -1) {
  341.         ipc_answer_fast(iid,ELIMIT,0,0);
  342.         return;
  343.     }
  344.     conn = &connections[consnum];
  345.     conn->used = 1;
  346.    
  347.     async_serialize_start();
  348.     gcons_notify_connect(consnum);
  349.     conn->client_phone = IPC_GET_ARG3(call);
  350.     screenbuffer_clear(&conn->screenbuffer);
  351.    
  352.     /* Accept the connection */
  353.     ipc_answer_fast(iid,0,0,0);
  354.  
  355.     while (1) {
  356.         async_serialize_end();
  357.         callid = async_get_call(&call);
  358.         async_serialize_start();
  359.  
  360.         arg1 = arg2 = 0;
  361.         switch (IPC_GET_METHOD(call)) {
  362.         case IPC_M_PHONE_HUNGUP:
  363.             gcons_notify_disconnect(consnum);
  364.            
  365.             /* Answer all pending requests */
  366.             while (conn->keyrequest_counter > 0) {     
  367.                 conn->keyrequest_counter--;
  368.                 ipc_answer_fast(fifo_pop(conn->keyrequests), ENOENT, 0, 0);
  369.                 break;
  370.             }
  371.            
  372.             /* Commit hangup */
  373.             ipc_answer_fast(callid, 0,0,0);
  374.             async_serialize_end();
  375.             return;
  376.         case CONSOLE_PUTCHAR:
  377.             write_char(consnum, IPC_GET_ARG1(call));
  378.             gcons_notify_char(consnum);
  379.             break;
  380.         case CONSOLE_CLEAR:
  381.             /* Send message to fb */
  382.             if (consnum == active_console) {
  383.                 async_msg(fb_info.phone, FB_CLEAR, 0);
  384.             }
  385.            
  386.             screenbuffer_clear(&conn->screenbuffer);
  387.            
  388.             break;
  389.         case CONSOLE_GOTO:
  390.            
  391.             screenbuffer_goto(&conn->screenbuffer, IPC_GET_ARG2(call), IPC_GET_ARG1(call));
  392.             if (consnum == active_console)
  393.                 curs_goto(IPC_GET_ARG1(call),IPC_GET_ARG2(call));
  394.            
  395.             break;
  396.  
  397.         case CONSOLE_GETSIZE:
  398.             arg1 = fb_info.rows;
  399.             arg2 = fb_info.cols;
  400.             break;
  401.         case CONSOLE_FLUSH:
  402.             async_req_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL);    
  403.             break;
  404.         case CONSOLE_SET_STYLE:
  405.            
  406.             arg1 = IPC_GET_ARG1(call);
  407.             arg2 = IPC_GET_ARG2(call);
  408.             screenbuffer_set_style(&conn->screenbuffer,arg1, arg2);
  409.             if (consnum == active_console)
  410.                 set_style_col(arg1, arg2);
  411.                
  412.             break;
  413.         case CONSOLE_CURSOR_VISIBILITY:
  414.             arg1 = IPC_GET_ARG1(call);
  415.             conn->screenbuffer.is_cursor_visible = arg1;
  416.             if (consnum == active_console)
  417.                 curs_visibility(arg1);
  418.             break;
  419.         case CONSOLE_GETCHAR:
  420.             if (keybuffer_empty(&conn->keybuffer)) {
  421.                 /* buffer is empty -> store request */
  422.                 if (conn->keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) {     
  423.                     fifo_push(conn->keyrequests, callid);
  424.                     conn->keyrequest_counter++;
  425.                 } else {
  426.                     /* no key available and too many requests => fail */
  427.                     ipc_answer_fast(callid, ELIMIT, 0, 0);
  428.                 }
  429.                 continue;
  430.             };
  431.             keybuffer_pop(&conn->keybuffer, (int *)&arg1);
  432.            
  433.             break;
  434.         }
  435.         ipc_answer_fast(callid, 0, arg1, arg2);
  436.     }
  437. }
  438.  
  439. int main(int argc, char *argv[])
  440. {
  441.     ipcarg_t phonehash;
  442.     int kbd_phone, fb_phone;
  443.     ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef;
  444.     int i;
  445.  
  446.     async_set_client_connection(client_connection);
  447.    
  448.     /* Connect to keyboard driver */
  449.  
  450.     while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {
  451.         usleep(10000);
  452.     };
  453.    
  454.     if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) {
  455.         return -1;
  456.     };
  457.  
  458.     /* Connect to framebuffer driver */
  459.    
  460.     while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {
  461.         usleep(10000);
  462.     }
  463.    
  464.     /* Save old kernel screen */
  465.     kernel_pixmap = switch_screens(-1);
  466.  
  467.     /* Initialize gcons */
  468.     gcons_init(fb_info.phone);
  469.     /* Synchronize, the gcons can have something in queue */
  470.     async_req(fb_info.phone, FB_FLUSH, 0, NULL);
  471.  
  472.    
  473.     ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));
  474.     set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
  475.     clrscr();
  476.    
  477.     /* Init virtual consoles */
  478.     for (i = 0; i < CONSOLE_COUNT; i++) {
  479.         connections[i].used = 0;
  480.         keybuffer_init(&(connections[i].keybuffer));
  481.        
  482.         connections[i].keyrequests.head = connections[i].keyrequests.tail = 0;
  483.         connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED;
  484.         connections[i].keyrequest_counter = 0;
  485.        
  486.         if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) {
  487.             /*FIXME: handle error */
  488.             return -1;
  489.         }
  490.     }
  491.     connections[KERNEL_CONSOLE].used = 1;
  492.    
  493.     if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ|PROTO_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, 0 ,0 )) != NULL) {
  494.         if (ipc_call_sync_3(fb_info.phone, IPC_M_AS_AREA_SEND, (ipcarg_t)interbuffer, 0, AS_AREA_READ, NULL, NULL, NULL) != 0) {
  495.             munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);
  496.             interbuffer = NULL;
  497.         }
  498.     }
  499.  
  500.     async_new_connection(phonehash, 0, NULL, keyboard_events);
  501.    
  502.     curs_goto(0,0);
  503.     curs_visibility(connections[active_console].screenbuffer.is_cursor_visible);
  504.  
  505.     /* Register at NS */
  506.     if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) {
  507.         return -1;
  508.     };
  509.    
  510.     async_manager();
  511.  
  512.     return 0;  
  513. }
  514.  
  515.