Subversion Repositories HelenOS

Rev

Rev 1552 | Rev 1560 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1552 Rev 1555
1
/*
1
/*
2
 * Copyright (C) 2006 Josef Cejka
2
 * Copyright (C) 2006 Josef Cejka
3
 * All rights reserved.
3
 * All rights reserved.
4
 *
4
 *
5
 * Redistribution and use in source and binary forms, with or without
5
 * Redistribution and use in source and binary forms, with or without
6
 * modification, are permitted provided that the following conditions
6
 * modification, are permitted provided that the following conditions
7
 * are met:
7
 * are met:
8
 *
8
 *
9
 * - Redistributions of source code must retain the above copyright
9
 * - Redistributions of source code must retain the above copyright
10
 *   notice, this list of conditions and the following disclaimer.
10
 *   notice, this list of conditions and the following disclaimer.
11
 * - Redistributions in binary form must reproduce the above copyright
11
 * - Redistributions in binary form must reproduce the above copyright
12
 *   notice, this list of conditions and the following disclaimer in the
12
 *   notice, this list of conditions and the following disclaimer in the
13
 *   documentation and/or other materials provided with the distribution.
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
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.
15
 *   derived from this software without specific prior written permission.
16
 *
16
 *
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
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
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
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
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
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
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.
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27
 */
27
 */
28
 
28
 
29
 
29
 
30
#include <kbd.h>
30
#include <kbd.h>
31
#include <fb.h>
31
#include <fb.h>
32
#include <ipc/ipc.h>
32
#include <ipc/ipc.h>
33
#include <ipc/fb.h>
33
#include <ipc/fb.h>
34
#include <ipc/services.h>
34
#include <ipc/services.h>
35
#include <errno.h>
35
#include <errno.h>
36
#include <key_buffer.h>
36
#include <key_buffer.h>
37
#include <console.h>
37
#include <console.h>
38
#include <unistd.h>
38
#include <unistd.h>
39
#include <async.h>
39
#include <async.h>
40
#include <libadt/fifo.h>
40
#include <libadt/fifo.h>
41
#include <screenbuffer.h>
41
#include <screenbuffer.h>
42
#include <sys/mman.h>
42
#include <sys/mman.h>
43
 
43
 
44
#include "gcons.h"
44
#include "gcons.h"
45
 
45
 
46
#define MAX_KEYREQUESTS_BUFFERED 32
46
#define MAX_KEYREQUESTS_BUFFERED 32
47
 
47
 
48
#define NAME "CONSOLE"
48
#define NAME "CONSOLE"
49
 
49
 
50
/** Index of currently used virtual console.
50
/** Index of currently used virtual console.
51
 */
51
 */
52
int active_console = 0;
52
int active_console = 0;
53
 
53
 
54
/** Information about framebuffer
54
/** Information about framebuffer
55
 */
55
 */
56
struct {
56
struct {
57
    int phone;      /**< Framebuffer phone */
57
    int phone;      /**< Framebuffer phone */
58
    ipcarg_t rows;      /**< Framebuffer rows */
58
    ipcarg_t rows;      /**< Framebuffer rows */
59
    ipcarg_t cols;      /**< Framebuffer columns */
59
    ipcarg_t cols;      /**< Framebuffer columns */
60
} fb_info;
60
} fb_info;
61
 
61
 
62
 
62
 
63
typedef struct {
63
typedef struct {
64
    keybuffer_t keybuffer;      /**< Buffer for incoming keys. */
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. */
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. */
66
    int keyrequest_counter;     /**< Number of requests in buffer. */
67
    int client_phone;       /**< Phone to connected client. */
67
    int client_phone;       /**< Phone to connected client. */
68
    int used;           /**< 1 if this virtual console is connected to some 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. */
69
    screenbuffer_t screenbuffer;    /**< Screenbuffer for saving screen contents and related settings. */
70
} connection_t;
70
} connection_t;
71
 
71
 
72
static connection_t connections[CONSOLE_COUNT]; /**< Array of data for virtual consoles */
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 */
73
static keyfield_t *interbuffer = NULL;          /**< Pointer to memory shared with framebufer used for faster virt. console switching */
74
 
74
 
75
static int kernel_pixmap = -1;      /**< Number of fb pixmap, where kernel console is stored */
75
static int kernel_pixmap = -1;      /**< Number of fb pixmap, where kernel console is stored */
76
 
76
 
77
 
77
 
78
/** Find unused virtual console.
78
/** Find unused virtual console.
79
 *
79
 *
80
 */
80
 */
81
static int find_free_connection()
81
static int find_free_connection()
82
{
82
{
83
    int i = 0;
83
    int i = 0;
84
   
84
   
85
    while (i < CONSOLE_COUNT) {
85
    while (i < CONSOLE_COUNT) {
86
        if (connections[i].used == 0)
86
        if (connections[i].used == 0)
87
            return i;
87
            return i;
88
        ++i;
88
        ++i;
89
    }
89
    }
90
    return CONSOLE_COUNT;
90
    return CONSOLE_COUNT;
91
}
91
}
92
 
92
 
93
/** Find index of virtual console used by client with given phone.
93
/** Find index of virtual console used by client with given phone.
94
 *
94
 *
95
 */
95
 */
96
static int find_connection(int client_phone)
96
static int find_connection(int client_phone)
97
{
97
{
98
    int i = 0;
98
    int i = 0;
99
   
99
   
100
    while (i < CONSOLE_COUNT) {
100
    while (i < CONSOLE_COUNT) {
101
        if (connections[i].client_phone == client_phone)
101
        if (connections[i].client_phone == client_phone)
102
            return i;
102
            return i;
103
        ++i;
103
        ++i;
104
    }
104
    }
105
    return  CONSOLE_COUNT;
105
    return  CONSOLE_COUNT;
106
}
106
}
107
 
107
 
108
static void clrscr(void)
108
static void clrscr(void)
109
{
109
{
110
    nsend_call(fb_info.phone, FB_CLEAR, 0);
110
    nsend_call(fb_info.phone, FB_CLEAR, 0);
111
}
111
}
112
 
112
 
113
static void curs_visibility(int v)
113
static void curs_visibility(int v)
114
{
114
{
115
    send_call(fb_info.phone, FB_CURSOR_VISIBILITY, v);
115
    send_call(fb_info.phone, FB_CURSOR_VISIBILITY, v);
116
}
116
}
117
 
117
 
118
static void curs_goto(int row, int col)
118
static void curs_goto(int row, int col)
119
{
119
{
120
    nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, row, col);
120
    nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, row, col);
121
   
121
   
122
}
122
}
123
 
123
 
124
static void set_style(style_t *style)
124
static void set_style(style_t *style)
125
{
125
{
126
    nsend_call_2(fb_info.phone, FB_SET_STYLE, style->fg_color, style->bg_color);
126
    nsend_call_2(fb_info.phone, FB_SET_STYLE, style->fg_color, style->bg_color);
127
}
127
}
128
 
128
 
129
static void set_style_col(int fgcolor, int bgcolor)
129
static void set_style_col(int fgcolor, int bgcolor)
130
{
130
{
131
    nsend_call_2(fb_info.phone, FB_SET_STYLE, fgcolor, bgcolor);
131
    nsend_call_2(fb_info.phone, FB_SET_STYLE, fgcolor, bgcolor);
132
}
132
}
133
 
133
 
134
static void prtchr(char c, int row, int col)
134
static void prtchr(char c, int row, int col)
135
{
135
{
136
    nsend_call_3(fb_info.phone, FB_PUTCHAR, c, row, col);
136
    nsend_call_3(fb_info.phone, FB_PUTCHAR, c, row, col);
137
   
137
   
138
}
138
}
139
 
139
 
140
/** Check key and process special keys.
140
/** Check key and process special keys.
141
 *
141
 *
142
 * */
142
 * */
143
static void write_char(int console, char key)
143
static void write_char(int console, char key)
144
{
144
{
145
    screenbuffer_t *scr = &(connections[console].screenbuffer);
145
    screenbuffer_t *scr = &(connections[console].screenbuffer);
146
   
146
   
147
    switch (key) {
147
    switch (key) {
148
        case '\n':
148
        case '\n':
149
            scr->position_y += 1;
149
            scr->position_y += 1;
150
            scr->position_x =  0;
150
            scr->position_x =  0;
151
            break;
151
            break;
152
        case '\r':
152
        case '\r':
153
            break;
153
            break;
154
        case '\t':
154
        case '\t':
155
            scr->position_x += 8;
155
            scr->position_x += 8;
156
            scr->position_x -= scr->position_x % 8;
156
            scr->position_x -= scr->position_x % 8;
157
            break;
157
            break;
158
        case '\b':
158
        case '\b':
159
            if (scr->position_x == 0)
159
            if (scr->position_x == 0)
160
                break;
160
                break;
161
 
161
 
162
            scr->position_x--;
162
            scr->position_x--;
163
 
163
 
164
            if (console == active_console)
164
            if (console == active_console)
165
                prtchr(' ', scr->position_y, scr->position_x);
165
                prtchr(' ', scr->position_y, scr->position_x);
166
   
166
   
167
            screenbuffer_putchar(scr, ' ');
167
            screenbuffer_putchar(scr, ' ');
168
           
168
           
169
            break;
169
            break;
170
        default:   
170
        default:   
171
            if (console == active_console)
171
            if (console == active_console)
172
                prtchr(key, scr->position_y, scr->position_x);
172
                prtchr(key, scr->position_y, scr->position_x);
173
   
173
   
174
            screenbuffer_putchar(scr, key);
174
            screenbuffer_putchar(scr, key);
175
            scr->position_x++;
175
            scr->position_x++;
176
    }
176
    }
177
   
177
   
178
    scr->position_y += (scr->position_x >= scr->size_x);
178
    scr->position_y += (scr->position_x >= scr->size_x);
179
   
179
   
180
    if (scr->position_y >= scr->size_y) {
180
    if (scr->position_y >= scr->size_y) {
181
        scr->position_y = scr->size_y - 1;
181
        scr->position_y = scr->size_y - 1;
182
        screenbuffer_clear_line(scr, scr->top_line++);
182
        screenbuffer_clear_line(scr, scr->top_line++);
183
        if (console == active_console)
183
        if (console == active_console)
184
            nsend_call(fb_info.phone, FB_SCROLL, 1);
184
            nsend_call(fb_info.phone, FB_SCROLL, 1);
185
    }
185
    }
186
   
186
   
187
    scr->position_x = scr->position_x % scr->size_x;
187
    scr->position_x = scr->position_x % scr->size_x;
188
   
188
   
189
    if (console == active_console)
189
    if (console == active_console)
190
        curs_goto(scr->position_y, scr->position_x);
190
        curs_goto(scr->position_y, scr->position_x);
191
   
191
   
192
}
192
}
193
 
193
 
194
/** Save current screen to pixmap, draw old pixmap
194
/** Save current screen to pixmap, draw old pixmap
195
 *
195
 *
196
 * @param oldpixmap Old pixmap
196
 * @param oldpixmap Old pixmap
197
 * @return ID of pixmap of current screen
197
 * @return ID of pixmap of current screen
198
 */
198
 */
199
static int switch_screens(int oldpixmap)
199
static int switch_screens(int oldpixmap)
200
{
200
{
201
    int newpmap;
201
    int newpmap;
202
       
202
       
203
    /* Save screen */
203
    /* Save screen */
204
    newpmap = sync_send(fb_info.phone, FB_VP2PIXMAP, 0, NULL);
204
    newpmap = sync_send(fb_info.phone, FB_VP2PIXMAP, 0, NULL);
205
    if (newpmap < 0)
205
    if (newpmap < 0)
206
        return -1;
206
        return -1;
207
 
207
 
208
    if (oldpixmap != -1) {
208
    if (oldpixmap != -1) {
209
        /* Show old screen */
209
        /* Show old screen */
210
        nsend_call_2(fb_info.phone, FB_VP_DRAW_PIXMAP, 0, oldpixmap);
210
        nsend_call_2(fb_info.phone, FB_VP_DRAW_PIXMAP, 0, oldpixmap);
211
        /* Drop old pixmap */
211
        /* Drop old pixmap */
212
        nsend_call(fb_info.phone, FB_DROP_PIXMAP, oldpixmap);
212
        nsend_call(fb_info.phone, FB_DROP_PIXMAP, oldpixmap);
213
    }
213
    }
214
   
214
   
215
    return newpmap;
215
    return newpmap;
216
}
216
}
217
 
217
 
218
/** Switch to new console */
218
/** Switch to new console */
219
static void change_console(int newcons)
219
static void change_console(int newcons)
220
{
220
{
221
    connection_t *conn;
221
    connection_t *conn;
222
    static int console_pixmap = -1;
222
    static int console_pixmap = -1;
223
    int i, j;
223
    int i, j;
224
    char c;
224
    char c;
225
 
225
 
226
    if (newcons == active_console)
226
    if (newcons == active_console)
227
        return;
227
        return;
228
 
228
 
229
    if (newcons == -1) {
229
    if (newcons == KERNEL_CONSOLE) {
230
        if (active_console == -1)
230
        if (active_console == KERNEL_CONSOLE)
231
            return;
231
            return;
232
        active_console = -1;
232
        active_console = KERNEL_CONSOLE;
233
        curs_visibility(0);
233
        curs_visibility(0);
234
 
234
 
235
        if (kernel_pixmap == -1) {
235
        if (kernel_pixmap == -1) {
236
            /* store/restore unsupported */
236
            /* store/restore unsupported */
237
            set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
237
            set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
238
            clrscr();
238
            clrscr();
239
        } else {
239
        } else {
240
            gcons_in_kernel();
240
            gcons_in_kernel();
241
            console_pixmap = switch_screens(kernel_pixmap);
241
            console_pixmap = switch_screens(kernel_pixmap);
242
            kernel_pixmap = -1;
242
            kernel_pixmap = -1;
243
        }
243
        }
244
 
244
 
245
        __SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
245
        __SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
246
        return;
246
        return;
247
    }
247
    }
248
   
248
   
249
    if (console_pixmap != -1) {
249
    if (console_pixmap != -1) {
250
        kernel_pixmap = switch_screens(console_pixmap);
250
        kernel_pixmap = switch_screens(console_pixmap);
251
        console_pixmap = -1;
251
        console_pixmap = -1;
252
    }
252
    }
253
   
253
   
254
    active_console = newcons;
254
    active_console = newcons;
255
    gcons_change_console(newcons);
255
    gcons_change_console(newcons);
256
    conn = &connections[active_console];
256
    conn = &connections[active_console];
257
 
257
 
258
    curs_visibility(0);
258
    curs_visibility(0);
259
    if (interbuffer) {
259
    if (interbuffer) {
260
        for (i = 0; i < conn->screenbuffer.size_x; i++)
260
        for (i = 0; i < conn->screenbuffer.size_x; i++)
261
            for (j = 0; j < conn->screenbuffer.size_y; j++)
261
            for (j = 0; j < conn->screenbuffer.size_y; j++)
262
                interbuffer[i + j*conn->screenbuffer.size_x] = *get_field_at(&(conn->screenbuffer),i, j);
262
                interbuffer[i + j*conn->screenbuffer.size_x] = *get_field_at(&(conn->screenbuffer),i, j);
263
       
263
       
264
        sync_send_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL);       
264
        sync_send_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL);       
265
    } else {
265
    } else {
266
        clrscr();
266
        clrscr();
267
       
267
       
268
        for (i = 0; i < conn->screenbuffer.size_x; i++)
268
        for (i = 0; i < conn->screenbuffer.size_x; i++)
269
            for (j = 0; j < conn->screenbuffer.size_y; j++) {
269
            for (j = 0; j < conn->screenbuffer.size_y; j++) {
270
                c = get_field_at(&(conn->screenbuffer),i, j)->character;
270
                c = get_field_at(&(conn->screenbuffer),i, j)->character;
271
                if (c && c != ' ')
271
                if (c && c != ' ')
272
                    prtchr(c, j, i);
272
                    prtchr(c, j, i);
273
            }
273
            }
274
       
274
       
275
    }
275
    }
276
    curs_goto(conn->screenbuffer.position_y, conn->screenbuffer.position_x);
276
    curs_goto(conn->screenbuffer.position_y, conn->screenbuffer.position_x);
277
    set_style(&conn->screenbuffer.style);
277
    set_style(&conn->screenbuffer.style);
278
    curs_visibility(1);
278
    curs_visibility(1);
279
}
279
}
280
 
280
 
281
/** Handler for keyboard */
281
/** Handler for keyboard */
282
static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
282
static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
283
{
283
{
284
    ipc_callid_t callid;
284
    ipc_callid_t callid;
285
    ipc_call_t call;
285
    ipc_call_t call;
286
    int retval;
286
    int retval;
287
    char c;
287
    char c;
288
    connection_t *conn;
288
    connection_t *conn;
289
   
289
   
290
    /* Ignore parameters, the connection is alread opened */
290
    /* Ignore parameters, the connection is alread opened */
291
    while (1) {
291
    while (1) {
292
        callid = async_get_call(&call);
292
        callid = async_get_call(&call);
293
        switch (IPC_GET_METHOD(call)) {
293
        switch (IPC_GET_METHOD(call)) {
294
        case IPC_M_PHONE_HUNGUP:
294
        case IPC_M_PHONE_HUNGUP:
295
            ipc_answer_fast(callid,0,0,0);
295
            ipc_answer_fast(callid,0,0,0);
296
            /* TODO: Handle hangup */
296
            /* TODO: Handle hangup */
297
            return;
297
            return;
298
        case KBD_PUSHCHAR:
298
        case KBD_PUSHCHAR:
299
            /* got key from keyboard driver */
299
            /* got key from keyboard driver */
300
           
300
           
301
            retval = 0;
301
            retval = 0;
302
            c = IPC_GET_ARG1(call);
302
            c = IPC_GET_ARG1(call);
303
            /* switch to another virtual console */
303
            /* switch to another virtual console */
304
           
304
           
305
            conn = &connections[active_console];
305
            conn = &connections[active_console];
306
//          if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) {
306
//          if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) {
307
            if ((c >= '0') && (c < '0' + CONSOLE_COUNT)) {
307
            if ((c >= '0') && (c < '0' + CONSOLE_COUNT)) {
308
                if (c == '0')
308
                if (c == '0')
309
                    change_console(-1);
309
                    change_console(KERNEL_CONSOLE);
310
                else
310
                else
311
                    change_console(c - '1');
311
                    change_console(c - '1');
312
                break;
312
                break;
313
            }
313
            }
314
           
314
           
315
            /* if client is awaiting key, send it */
315
            /* if client is awaiting key, send it */
316
            if (conn->keyrequest_counter > 0) {    
316
            if (conn->keyrequest_counter > 0) {    
317
                conn->keyrequest_counter--;
317
                conn->keyrequest_counter--;
318
                ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0);
318
                ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0);
319
                break;
319
                break;
320
            }
320
            }
321
           
321
           
322
            /*FIXME: else store key to its buffer */
322
            /*FIXME: else store key to its buffer */
323
            keybuffer_push(&conn->keybuffer, c);
323
            keybuffer_push(&conn->keybuffer, c);
324
           
324
           
325
            break;
325
            break;
326
        default:
326
        default:
327
            retval = ENOENT;
327
            retval = ENOENT;
328
        }      
328
        }      
329
        ipc_answer_fast(callid, retval, 0, 0);
329
        ipc_answer_fast(callid, retval, 0, 0);
330
    }
330
    }
331
}
331
}
332
 
332
 
333
/** Default thread for new connections */
333
/** Default thread for new connections */
334
static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
334
static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
335
{
335
{
336
    ipc_callid_t callid;
336
    ipc_callid_t callid;
337
    ipc_call_t call;
337
    ipc_call_t call;
338
    int consnum;
338
    int consnum;
339
    ipcarg_t arg1, arg2;
339
    ipcarg_t arg1, arg2;
340
 
340
 
341
    if ((consnum = find_free_connection()) == CONSOLE_COUNT) {
341
    if ((consnum = find_free_connection()) == CONSOLE_COUNT) {
342
        ipc_answer_fast(iid,ELIMIT,0,0);
342
        ipc_answer_fast(iid,ELIMIT,0,0);
343
        return;
343
        return;
344
    }
344
    }
345
 
345
   
-
 
346
    gcons_notify_connect(consnum);
346
    connections[consnum].used = 1;
347
    connections[consnum].used = 1;
347
    connections[consnum].client_phone = IPC_GET_ARG3(call);
348
    connections[consnum].client_phone = IPC_GET_ARG3(call);
348
    screenbuffer_clear(&(connections[consnum].screenbuffer));
349
    screenbuffer_clear(&(connections[consnum].screenbuffer));
349
   
350
   
350
    /* Accept the connection */
351
    /* Accept the connection */
351
    ipc_answer_fast(iid,0,0,0);
352
    ipc_answer_fast(iid,0,0,0);
352
   
353
   
353
    while (1) {
354
    while (1) {
354
        callid = async_get_call(&call);
355
        callid = async_get_call(&call);
355
        arg1 = arg2 = 0;
356
        arg1 = arg2 = 0;
356
        switch (IPC_GET_METHOD(call)) {
357
        switch (IPC_GET_METHOD(call)) {
357
        case IPC_M_PHONE_HUNGUP:
358
        case IPC_M_PHONE_HUNGUP:
358
            /* TODO */
359
            /* TODO */
359
            ipc_answer_fast(callid, 0,0,0);
360
            ipc_answer_fast(callid, 0,0,0);
360
            return;
361
            return;
361
        case CONSOLE_PUTCHAR:
362
        case CONSOLE_PUTCHAR:
362
            write_char(consnum, IPC_GET_ARG1(call));
363
            write_char(consnum, IPC_GET_ARG1(call));
363
            gcons_notify_char(consnum);
364
            gcons_notify_char(consnum);
364
            break;
365
            break;
365
        case CONSOLE_CLEAR:
366
        case CONSOLE_CLEAR:
366
            /* Send message to fb */
367
            /* Send message to fb */
367
            if (consnum == active_console) {
368
            if (consnum == active_console) {
368
                send_call(fb_info.phone, FB_CLEAR, 0);
369
                send_call(fb_info.phone, FB_CLEAR, 0);
369
            }
370
            }
370
           
371
           
371
            screenbuffer_clear(&(connections[consnum].screenbuffer));
372
            screenbuffer_clear(&(connections[consnum].screenbuffer));
372
           
373
           
373
            break;
374
            break;
374
        case CONSOLE_GOTO:
375
        case CONSOLE_GOTO:
375
           
376
           
376
            screenbuffer_goto(&(connections[consnum].screenbuffer), IPC_GET_ARG2(call), IPC_GET_ARG1(call));
377
            screenbuffer_goto(&(connections[consnum].screenbuffer), IPC_GET_ARG2(call), IPC_GET_ARG1(call));
377
           
378
           
378
            break;
379
            break;
379
 
380
 
380
        case CONSOLE_GETSIZE:
381
        case CONSOLE_GETSIZE:
381
            arg1 = fb_info.rows;
382
            arg1 = fb_info.rows;
382
            arg2 = fb_info.cols;
383
            arg2 = fb_info.cols;
383
            break;
384
            break;
384
        case CONSOLE_FLUSH:
385
        case CONSOLE_FLUSH:
385
            sync_send_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL);    
386
            sync_send_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL);    
386
            break;
387
            break;
387
        case CONSOLE_SET_STYLE:
388
        case CONSOLE_SET_STYLE:
388
           
389
           
389
            arg1 = IPC_GET_ARG1(call);
390
            arg1 = IPC_GET_ARG1(call);
390
            arg2 = IPC_GET_ARG2(call);
391
            arg2 = IPC_GET_ARG2(call);
391
            screenbuffer_set_style(&(connections[consnum].screenbuffer),arg1, arg2);
392
            screenbuffer_set_style(&(connections[consnum].screenbuffer),arg1, arg2);
392
            if (consnum == active_console)
393
            if (consnum == active_console)
393
                set_style_col(arg1, arg2);
394
                set_style_col(arg1, arg2);
394
               
395
               
395
            break;
396
            break;
396
        case CONSOLE_GETCHAR:
397
        case CONSOLE_GETCHAR:
397
            if (keybuffer_empty(&(connections[consnum].keybuffer))) {
398
            if (keybuffer_empty(&(connections[consnum].keybuffer))) {
398
                /* buffer is empty -> store request */
399
                /* buffer is empty -> store request */
399
                if (connections[consnum].keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) {      
400
                if (connections[consnum].keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) {      
400
                    fifo_push(connections[consnum].keyrequests, callid);
401
                    fifo_push(connections[consnum].keyrequests, callid);
401
                    connections[consnum].keyrequest_counter++;
402
                    connections[consnum].keyrequest_counter++;
402
                } else {
403
                } else {
403
                    /* no key available and too many requests => fail */
404
                    /* no key available and too many requests => fail */
404
                    ipc_answer_fast(callid, ELIMIT, 0, 0);
405
                    ipc_answer_fast(callid, ELIMIT, 0, 0);
405
                }
406
                }
406
                continue;
407
                continue;
407
            };
408
            };
408
            keybuffer_pop(&(connections[consnum].keybuffer), (char *)&arg1);
409
            keybuffer_pop(&(connections[consnum].keybuffer), (char *)&arg1);
409
           
410
           
410
            break;
411
            break;
411
        }
412
        }
412
        ipc_answer_fast(callid, 0, arg1, arg2);
413
        ipc_answer_fast(callid, 0, arg1, arg2);
413
    }
414
    }
414
}
415
}
415
 
416
 
416
int main(int argc, char *argv[])
417
int main(int argc, char *argv[])
417
{
418
{
418
    ipcarg_t phonehash;
419
    ipcarg_t phonehash;
419
    int kbd_phone, fb_phone;
420
    int kbd_phone, fb_phone;
420
    ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef;
421
    ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef;
421
    int i;
422
    int i;
422
 
423
 
423
    async_set_client_connection(client_connection);
424
    async_set_client_connection(client_connection);
424
   
425
   
425
    /* Connect to keyboard driver */
426
    /* Connect to keyboard driver */
426
 
427
 
427
    while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {
428
    while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {
428
        usleep(10000);
429
        usleep(10000);
429
    };
430
    };
430
   
431
   
431
    if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) {
432
    if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) {
432
        return -1;
433
        return -1;
433
    };
434
    };
434
 
435
 
435
    /* Connect to framebuffer driver */
436
    /* Connect to framebuffer driver */
436
   
437
   
437
    while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {
438
    while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {
438
        usleep(10000);
439
        usleep(10000);
439
    }
440
    }
440
   
441
   
441
    /* Save old kernel screen */
442
    /* Save old kernel screen */
442
    kernel_pixmap = switch_screens(-1);
443
    kernel_pixmap = switch_screens(-1);
443
 
444
 
444
    /* Initialize gcons */
445
    /* Initialize gcons */
445
    gcons_init(fb_info.phone);
446
    gcons_init(fb_info.phone);
446
    /* Synchronize, the gcons can have something in queue */
447
    /* Synchronize, the gcons can have something in queue */
447
    sync_send_2(fb_info.phone, FB_GET_CSIZE, 0, 0, NULL, NULL);
448
    sync_send_2(fb_info.phone, FB_GET_CSIZE, 0, 0, NULL, NULL);
448
 
449
 
449
   
450
   
450
    ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));
451
    ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));
451
    set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
452
    set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
452
    clrscr();
453
    clrscr();
453
   
454
   
454
    /* Init virtual consoles */
455
    /* Init virtual consoles */
455
    for (i = 0; i < CONSOLE_COUNT; i++) {
456
    for (i = 0; i < CONSOLE_COUNT; i++) {
456
        connections[i].used = 0;
457
        connections[i].used = 0;
457
        keybuffer_init(&(connections[i].keybuffer));
458
        keybuffer_init(&(connections[i].keybuffer));
458
       
459
       
459
        connections[i].keyrequests.head = connections[i].keyrequests.tail = 0;
460
        connections[i].keyrequests.head = connections[i].keyrequests.tail = 0;
460
        connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED;
461
        connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED;
461
        connections[i].keyrequest_counter = 0;
462
        connections[i].keyrequest_counter = 0;
462
       
463
       
463
        if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) {
464
        if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) {
464
            /*FIXME: handle error */
465
            /*FIXME: handle error */
465
            return -1;
466
            return -1;
466
        }
467
        }
467
    }
468
    }
468
   
469
   
469
    if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ|PROTO_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, 0 ,0 )) != NULL) {
470
    if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ|PROTO_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, 0 ,0 )) != NULL) {
470
        if (ipc_call_sync_3(fb_info.phone, IPC_M_AS_AREA_SEND, (ipcarg_t)interbuffer, 0, AS_AREA_READ, NULL, NULL, NULL) != 0) {
471
        if (ipc_call_sync_3(fb_info.phone, IPC_M_AS_AREA_SEND, (ipcarg_t)interbuffer, 0, AS_AREA_READ, NULL, NULL, NULL) != 0) {
471
            munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);
472
            munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);
472
            interbuffer = NULL;
473
            interbuffer = NULL;
473
        }
474
        }
474
    }
475
    }
475
 
476
 
476
    async_new_connection(phonehash, 0, NULL, keyboard_events);
477
    async_new_connection(phonehash, 0, NULL, keyboard_events);
477
   
478
   
478
    sync_send_2(fb_info.phone, FB_CURSOR_GOTO, 0, 0, NULL, NULL);
479
    sync_send_2(fb_info.phone, FB_CURSOR_GOTO, 0, 0, NULL, NULL);
479
    nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);
480
    nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);
480
 
481
 
481
    /* Register at NS */
482
    /* Register at NS */
482
    if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) {
483
    if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) {
483
        return -1;
484
        return -1;
484
    };
485
    };
485
   
486
   
486
    async_manager();
487
    async_manager();
487
 
488
 
488
    return 0;  
489
    return 0;  
489
}
490
}
490
 
491
 
491
 
492