source: mainline/console/console.c@ 390a678

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since 390a678 was 390a678, checked in by Josef Cejka <malyzelenyhnus@…>, 19 years ago

Console support for communication with fb via shared memory.

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