Subversion Repositories HelenOS-historic

Rev

Rev 1516 | Rev 1518 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed

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