Rev 1526 | Rev 1533 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 1526 | Rev 1528 | ||
---|---|---|---|
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 | connection_t connections[CONSOLE_COUNT]; /**< Array of data for virtual consoles */ |
72 | connection_t connections[CONSOLE_COUNT]; /**< Array of data for virtual consoles */ |
73 | keyfield_t *interbuffer = NULL; /**< Pointer to memory shared with framebufer used for faster virt. console switching */ |
73 | keyfield_t *interbuffer = NULL; /**< Pointer to memory shared with framebufer used for faster virt. console switching */ |
74 | 74 | ||
75 | 75 | ||
76 | /** Find unused virtual console. |
76 | /** Find unused virtual console. |
77 | * |
77 | * |
78 | */ |
78 | */ |
79 | static int find_free_connection() |
79 | static int find_free_connection() |
80 | { |
80 | { |
81 | int i = 0; |
81 | int i = 0; |
82 | 82 | ||
83 | while (i < CONSOLE_COUNT) { |
83 | while (i < CONSOLE_COUNT) { |
84 | if (connections[i].used == 0) |
84 | if (connections[i].used == 0) |
85 | return i; |
85 | return i; |
86 | ++i; |
86 | ++i; |
87 | } |
87 | } |
88 | return CONSOLE_COUNT; |
88 | return CONSOLE_COUNT; |
89 | } |
89 | } |
90 | 90 | ||
91 | /** Find index of virtual console used by client with given phone. |
91 | /** Find index of virtual console used by client with given phone. |
92 | * |
92 | * |
93 | */ |
93 | */ |
94 | static int find_connection(int client_phone) |
94 | static int find_connection(int client_phone) |
95 | { |
95 | { |
96 | int i = 0; |
96 | int i = 0; |
97 | 97 | ||
98 | while (i < CONSOLE_COUNT) { |
98 | while (i < CONSOLE_COUNT) { |
99 | if (connections[i].client_phone == client_phone) |
99 | if (connections[i].client_phone == client_phone) |
100 | return i; |
100 | return i; |
101 | ++i; |
101 | ++i; |
102 | } |
102 | } |
103 | return CONSOLE_COUNT; |
103 | return CONSOLE_COUNT; |
104 | } |
104 | } |
105 | 105 | ||
106 | /** Check key and process special keys. |
106 | /** Check key and process special keys. |
107 | * |
107 | * |
108 | * */ |
108 | * */ |
109 | static void write_char(int console, char key) |
109 | static void write_char(int console, char key) |
110 | { |
110 | { |
111 | screenbuffer_t *scr = &(connections[console].screenbuffer); |
111 | screenbuffer_t *scr = &(connections[console].screenbuffer); |
112 | 112 | ||
113 | switch (key) { |
113 | switch (key) { |
114 | case '\n': |
114 | case '\n': |
115 | scr->position_y += 1; |
115 | scr->position_y += 1; |
116 | scr->position_x = 0; |
116 | scr->position_x = 0; |
117 | break; |
117 | break; |
118 | case '\r': |
118 | case '\r': |
119 | break; |
119 | break; |
120 | case '\t': |
120 | case '\t': |
121 | scr->position_x += 8; |
121 | scr->position_x += 8; |
122 | scr->position_x -= scr->position_x % 8; |
122 | scr->position_x -= scr->position_x % 8; |
123 | break; |
123 | break; |
124 | case '\b': |
124 | case '\b': |
125 | if (scr->position_x == 0) |
125 | if (scr->position_x == 0) |
126 | break; |
126 | break; |
127 | 127 | ||
128 | scr->position_x--; |
128 | scr->position_x--; |
129 | 129 | ||
130 | if (console == active_console) { |
130 | if (console == active_console) { |
131 | nsend_call_3(fb_info.phone, FB_PUTCHAR, ' ', scr->position_y, scr->position_x); |
131 | nsend_call_3(fb_info.phone, FB_PUTCHAR, ' ', scr->position_y, scr->position_x); |
132 | } |
132 | } |
133 | 133 | ||
134 | screenbuffer_putchar(scr, ' '); |
134 | screenbuffer_putchar(scr, ' '); |
135 | 135 | ||
136 | break; |
136 | break; |
137 | default: |
137 | default: |
138 | if (console == active_console) { |
138 | if (console == active_console) { |
139 | nsend_call_3(fb_info.phone, FB_PUTCHAR, key, scr->position_y, scr->position_x); |
139 | nsend_call_3(fb_info.phone, FB_PUTCHAR, key, scr->position_y, scr->position_x); |
140 | } |
140 | } |
141 | 141 | ||
142 | screenbuffer_putchar(scr, key); |
142 | screenbuffer_putchar(scr, key); |
143 | scr->position_x++; |
143 | scr->position_x++; |
144 | } |
144 | } |
145 | 145 | ||
146 | scr->position_y += (scr->position_x >= scr->size_x); |
146 | scr->position_y += (scr->position_x >= scr->size_x); |
147 | 147 | ||
148 | if (scr->position_y >= scr->size_y) { |
148 | if (scr->position_y >= scr->size_y) { |
149 | scr->position_y = scr->size_y - 1; |
149 | scr->position_y = scr->size_y - 1; |
150 | screenbuffer_clear_line(scr, scr->top_line++); |
150 | screenbuffer_clear_line(scr, scr->top_line++); |
151 | if (console == active_console) |
151 | if (console == active_console) |
152 | nsend_call(fb_info.phone, FB_SCROLL, 1); |
152 | nsend_call(fb_info.phone, FB_SCROLL, 1); |
153 | } |
153 | } |
154 | 154 | ||
155 | scr->position_x = scr->position_x % scr->size_x; |
155 | scr->position_x = scr->position_x % scr->size_x; |
156 | 156 | ||
157 | if (console == active_console) |
157 | if (console == active_console) |
158 | send_call_2(fb_info.phone, FB_CURSOR_GOTO, scr->position_y, scr->position_x); |
158 | send_call_2(fb_info.phone, FB_CURSOR_GOTO, scr->position_y, scr->position_x); |
159 | 159 | ||
160 | } |
160 | } |
161 | 161 | ||
162 | 162 | ||
163 | /** Handler for keyboard */ |
163 | /** Handler for keyboard */ |
164 | static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall) |
164 | static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall) |
165 | { |
165 | { |
166 | ipc_callid_t callid; |
166 | ipc_callid_t callid; |
167 | ipc_call_t call; |
167 | ipc_call_t call; |
168 | int retval; |
168 | int retval; |
169 | int i, j; |
169 | int i, j; |
170 | char c,d; |
170 | char c,d; |
171 | connection_t *conn; |
171 | connection_t *conn; |
172 | 172 | ||
173 | /* Ignore parameters, the connection is alread opened */ |
173 | /* Ignore parameters, the connection is alread opened */ |
174 | while (1) { |
174 | while (1) { |
175 | callid = async_get_call(&call); |
175 | callid = async_get_call(&call); |
176 | switch (IPC_GET_METHOD(call)) { |
176 | switch (IPC_GET_METHOD(call)) { |
177 | case IPC_M_PHONE_HUNGUP: |
177 | case IPC_M_PHONE_HUNGUP: |
178 | ipc_answer_fast(callid,0,0,0); |
178 | ipc_answer_fast(callid,0,0,0); |
179 | /* TODO: Handle hangup */ |
179 | /* TODO: Handle hangup */ |
180 | return; |
180 | return; |
181 | case KBD_PUSHCHAR: |
181 | case KBD_PUSHCHAR: |
182 | /* got key from keyboard driver */ |
182 | /* got key from keyboard driver */ |
183 | 183 | ||
184 | retval = 0; |
184 | retval = 0; |
185 | c = IPC_GET_ARG1(call); |
185 | c = IPC_GET_ARG1(call); |
186 | /* switch to another virtual console */ |
186 | /* switch to another virtual console */ |
187 | 187 | ||
188 | conn = &connections[active_console]; |
188 | conn = &connections[active_console]; |
189 | // if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) { |
189 | // if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) { |
190 | if ((c >= '0') && (c < '0' + CONSOLE_COUNT)) { |
190 | if ((c >= '0') && (c < '0' + CONSOLE_COUNT)) { |
191 | if (c == '0') { |
191 | if (c == '0') { |
192 | /* switch to kernel console*/ |
192 | /* switch to kernel console*/ |
193 | nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 0); |
193 | nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 0); |
194 | nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR); |
194 | nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR); |
195 | nsend_call(fb_info.phone, FB_CLEAR, 0); |
195 | nsend_call(fb_info.phone, FB_CLEAR, 0); |
196 | /* FIXME: restore kernel console */ |
196 | /* FIXME: restore kernel console */ |
197 | __SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE); |
197 | __SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE); |
198 | break; |
198 | break; |
199 | 199 | ||
200 | } else { |
200 | } else { |
201 | c = c - '1'; |
201 | c = c - '1'; |
202 | if (c == active_console) |
202 | if (c == active_console) |
203 | break; |
203 | break; |
204 | active_console = c; |
204 | active_console = c; |
205 | gcons_change_console(c); |
205 | gcons_change_console(c); |
206 | 206 | ||
207 | } |
207 | } |
208 | 208 | ||
209 | conn = &connections[active_console]; |
209 | conn = &connections[active_console]; |
210 | 210 | ||
211 | nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 0); |
211 | nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 0); |
212 | 212 | ||
213 | if (interbuffer) { |
213 | if (interbuffer) { |
214 | for (i = 0; i < conn->screenbuffer.size_x; i++) |
214 | for (i = 0; i < conn->screenbuffer.size_x; i++) |
215 | for (j = 0; j < conn->screenbuffer.size_y; j++) |
215 | for (j = 0; j < conn->screenbuffer.size_y; j++) |
216 | interbuffer[i + j*conn->screenbuffer.size_x] = *get_field_at(&(conn->screenbuffer),i, j); |
216 | interbuffer[i + j*conn->screenbuffer.size_x] = *get_field_at(&(conn->screenbuffer),i, j); |
217 | 217 | ||
218 | sync_send_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL); |
218 | sync_send_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL); |
219 | } else { |
219 | } else { |
220 | nsend_call(fb_info.phone, FB_CLEAR, 0); |
220 | nsend_call(fb_info.phone, FB_CLEAR, 0); |
221 | 221 | ||
222 | 222 | ||
223 | for (i = 0; i < conn->screenbuffer.size_x; i++) |
223 | for (i = 0; i < conn->screenbuffer.size_x; i++) |
224 | for (j = 0; j < conn->screenbuffer.size_y; j++) { |
224 | for (j = 0; j < conn->screenbuffer.size_y; j++) { |
225 | d = get_field_at(&(conn->screenbuffer),i, j)->character; |
225 | d = get_field_at(&(conn->screenbuffer),i, j)->character; |
226 | if (d && d != ' ') |
226 | if (d && d != ' ') |
227 | nsend_call_3(fb_info.phone, FB_PUTCHAR, d, j, i); |
227 | nsend_call_3(fb_info.phone, FB_PUTCHAR, d, j, i); |
228 | } |
228 | } |
229 | 229 | ||
230 | } |
230 | } |
231 | nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, conn->screenbuffer.position_y, conn->screenbuffer.position_x); |
231 | nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, conn->screenbuffer.position_y, conn->screenbuffer.position_x); |
232 | nsend_call_2(fb_info.phone, FB_SET_STYLE, conn->screenbuffer.style.fg_color, \ |
232 | nsend_call_2(fb_info.phone, FB_SET_STYLE, conn->screenbuffer.style.fg_color, \ |
233 | conn->screenbuffer.style.bg_color); |
233 | conn->screenbuffer.style.bg_color); |
234 | send_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1); |
234 | send_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1); |
235 | 235 | ||
236 | break; |
236 | break; |
237 | } |
237 | } |
238 | 238 | ||
239 | /* if client is awaiting key, send it */ |
239 | /* if client is awaiting key, send it */ |
240 | if (conn->keyrequest_counter > 0) { |
240 | if (conn->keyrequest_counter > 0) { |
241 | conn->keyrequest_counter--; |
241 | conn->keyrequest_counter--; |
242 | ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0); |
242 | ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0); |
243 | break; |
243 | break; |
244 | } |
244 | } |
245 | 245 | ||
246 | /*FIXME: else store key to its buffer */ |
246 | /*FIXME: else store key to its buffer */ |
247 | keybuffer_push(&conn->keybuffer, c); |
247 | keybuffer_push(&conn->keybuffer, c); |
248 | 248 | ||
249 | break; |
249 | break; |
250 | default: |
250 | default: |
251 | retval = ENOENT; |
251 | retval = ENOENT; |
252 | } |
252 | } |
253 | ipc_answer_fast(callid, retval, 0, 0); |
253 | ipc_answer_fast(callid, retval, 0, 0); |
254 | } |
254 | } |
255 | } |
255 | } |
256 | 256 | ||
257 | /** Default thread for new connections */ |
257 | /** Default thread for new connections */ |
258 | static void client_connection(ipc_callid_t iid, ipc_call_t *icall) |
258 | static void client_connection(ipc_callid_t iid, ipc_call_t *icall) |
259 | { |
259 | { |
260 | ipc_callid_t callid; |
260 | ipc_callid_t callid; |
261 | ipc_call_t call; |
261 | ipc_call_t call; |
262 | int consnum; |
262 | int consnum; |
263 | ipcarg_t arg1, arg2; |
263 | ipcarg_t arg1, arg2; |
264 | 264 | ||
265 | if ((consnum = find_free_connection()) == CONSOLE_COUNT) { |
265 | if ((consnum = find_free_connection()) == CONSOLE_COUNT) { |
266 | ipc_answer_fast(iid,ELIMIT,0,0); |
266 | ipc_answer_fast(iid,ELIMIT,0,0); |
267 | return; |
267 | return; |
268 | } |
268 | } |
269 | 269 | ||
270 | connections[consnum].used = 1; |
270 | connections[consnum].used = 1; |
271 | connections[consnum].client_phone = IPC_GET_ARG3(call); |
271 | connections[consnum].client_phone = IPC_GET_ARG3(call); |
272 | screenbuffer_clear(&(connections[consnum].screenbuffer)); |
272 | screenbuffer_clear(&(connections[consnum].screenbuffer)); |
273 | 273 | ||
274 | /* Accept the connection */ |
274 | /* Accept the connection */ |
275 | ipc_answer_fast(iid,0,0,0); |
275 | ipc_answer_fast(iid,0,0,0); |
276 | 276 | ||
277 | while (1) { |
277 | while (1) { |
278 | callid = async_get_call(&call); |
278 | callid = async_get_call(&call); |
279 | arg1 = arg2 = 0; |
279 | arg1 = arg2 = 0; |
280 | switch (IPC_GET_METHOD(call)) { |
280 | switch (IPC_GET_METHOD(call)) { |
281 | case IPC_M_PHONE_HUNGUP: |
281 | case IPC_M_PHONE_HUNGUP: |
282 | /* TODO */ |
282 | /* TODO */ |
283 | ipc_answer_fast(callid, 0,0,0); |
283 | ipc_answer_fast(callid, 0,0,0); |
284 | return; |
284 | return; |
285 | case CONSOLE_PUTCHAR: |
285 | case CONSOLE_PUTCHAR: |
286 | write_char(consnum, IPC_GET_ARG1(call)); |
286 | write_char(consnum, IPC_GET_ARG1(call)); |
- | 287 | gcons_notify_char(consnum); |
|
287 | break; |
288 | break; |
288 | case CONSOLE_CLEAR: |
289 | case CONSOLE_CLEAR: |
289 | /* Send message to fb */ |
290 | /* Send message to fb */ |
290 | if (consnum == active_console) { |
291 | if (consnum == active_console) { |
291 | send_call(fb_info.phone, FB_CLEAR, 0); |
292 | send_call(fb_info.phone, FB_CLEAR, 0); |
292 | } |
293 | } |
293 | 294 | ||
294 | screenbuffer_clear(&(connections[consnum].screenbuffer)); |
295 | screenbuffer_clear(&(connections[consnum].screenbuffer)); |
295 | 296 | ||
296 | break; |
297 | break; |
297 | case CONSOLE_GOTO: |
298 | case CONSOLE_GOTO: |
298 | 299 | ||
299 | screenbuffer_goto(&(connections[consnum].screenbuffer), IPC_GET_ARG1(call), IPC_GET_ARG2(call)); |
300 | screenbuffer_goto(&(connections[consnum].screenbuffer), IPC_GET_ARG2(call), IPC_GET_ARG1(call)); |
300 | 301 | ||
301 | break; |
302 | break; |
302 | 303 | ||
303 | case CONSOLE_GETSIZE: |
304 | case CONSOLE_GETSIZE: |
304 | arg1 = fb_info.cols; |
305 | arg1 = fb_info.rows; |
305 | arg2 = fb_info.rows; |
306 | arg2 = fb_info.cols; |
306 | break; |
307 | break; |
307 | case CONSOLE_FLUSH: |
308 | case CONSOLE_FLUSH: |
308 | sync_send_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL); |
309 | sync_send_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL); |
309 | break; |
310 | break; |
310 | case CONSOLE_SET_STYLE: |
311 | case CONSOLE_SET_STYLE: |
311 | 312 | ||
312 | arg1 = IPC_GET_ARG1(call); |
313 | arg1 = IPC_GET_ARG1(call); |
313 | arg2 = IPC_GET_ARG2(call); |
314 | arg2 = IPC_GET_ARG2(call); |
314 | screenbuffer_set_style(&(connections[consnum]),arg1, arg2); |
315 | screenbuffer_set_style(&(connections[consnum]),arg1, arg2); |
315 | if (consnum == active_console) |
316 | if (consnum == active_console) |
316 | nsend_call_2(fb_info.phone, FB_SET_STYLE, arg1, arg2); |
317 | nsend_call_2(fb_info.phone, FB_SET_STYLE, arg1, arg2); |
317 | 318 | ||
318 | break; |
319 | break; |
319 | case CONSOLE_GETCHAR: |
320 | case CONSOLE_GETCHAR: |
320 | if (keybuffer_empty(&(connections[consnum].keybuffer))) { |
321 | if (keybuffer_empty(&(connections[consnum].keybuffer))) { |
321 | /* buffer is empty -> store request */ |
322 | /* buffer is empty -> store request */ |
322 | if (connections[consnum].keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) { |
323 | if (connections[consnum].keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) { |
323 | fifo_push(connections[consnum].keyrequests, callid); |
324 | fifo_push(connections[consnum].keyrequests, callid); |
324 | connections[consnum].keyrequest_counter++; |
325 | connections[consnum].keyrequest_counter++; |
325 | } else { |
326 | } else { |
326 | /* no key available and too many requests => fail */ |
327 | /* no key available and too many requests => fail */ |
327 | ipc_answer_fast(callid, ELIMIT, 0, 0); |
328 | ipc_answer_fast(callid, ELIMIT, 0, 0); |
328 | } |
329 | } |
329 | continue; |
330 | continue; |
330 | }; |
331 | }; |
331 | keybuffer_pop(&(connections[consnum].keybuffer), (char *)&arg1); |
332 | keybuffer_pop(&(connections[consnum].keybuffer), (char *)&arg1); |
332 | 333 | ||
333 | break; |
334 | break; |
334 | } |
335 | } |
335 | ipc_answer_fast(callid, 0, arg1, arg2); |
336 | ipc_answer_fast(callid, 0, arg1, arg2); |
336 | } |
337 | } |
337 | } |
338 | } |
338 | 339 | ||
339 | int main(int argc, char *argv[]) |
340 | int main(int argc, char *argv[]) |
340 | { |
341 | { |
341 | ipcarg_t phonehash; |
342 | ipcarg_t phonehash; |
342 | int kbd_phone, fb_phone; |
343 | int kbd_phone, fb_phone; |
343 | ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef; |
344 | ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef; |
344 | int i; |
345 | int i; |
345 | 346 | ||
346 | async_set_client_connection(client_connection); |
347 | async_set_client_connection(client_connection); |
347 | 348 | ||
348 | /* Connect to keyboard driver */ |
349 | /* Connect to keyboard driver */ |
349 | 350 | ||
350 | while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) { |
351 | while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) { |
351 | usleep(10000); |
352 | usleep(10000); |
352 | }; |
353 | }; |
353 | 354 | ||
354 | if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) { |
355 | if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) { |
355 | return -1; |
356 | return -1; |
356 | }; |
357 | }; |
357 | 358 | ||
358 | /* Connect to framebuffer driver */ |
359 | /* Connect to framebuffer driver */ |
359 | 360 | ||
360 | while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) { |
361 | while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) { |
361 | usleep(10000); |
362 | usleep(10000); |
362 | } |
363 | } |
363 | 364 | ||
364 | /* Initialize gcons */ |
365 | /* Initialize gcons */ |
365 | gcons_init(fb_info.phone); |
366 | gcons_init(fb_info.phone); |
366 | /* Synchronize, the gcons can have something in queue */ |
367 | /* Synchronize, the gcons can have something in queue */ |
367 | sync_send_2(fb_info.phone, FB_GET_CSIZE, 0, 0, NULL, NULL); |
368 | sync_send_2(fb_info.phone, FB_GET_CSIZE, 0, 0, NULL, NULL); |
368 | 369 | ||
369 | 370 | ||
370 | ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols)); |
371 | ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols)); |
371 | nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR); |
372 | nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR); |
372 | nsend_call(fb_info.phone, FB_CLEAR, 0); |
373 | nsend_call(fb_info.phone, FB_CLEAR, 0); |
373 | 374 | ||
374 | /* Init virtual consoles */ |
375 | /* Init virtual consoles */ |
375 | for (i = 0; i < CONSOLE_COUNT; i++) { |
376 | for (i = 0; i < CONSOLE_COUNT; i++) { |
376 | connections[i].used = 0; |
377 | connections[i].used = 0; |
377 | keybuffer_init(&(connections[i].keybuffer)); |
378 | keybuffer_init(&(connections[i].keybuffer)); |
378 | 379 | ||
379 | connections[i].keyrequests.head = connections[i].keyrequests.tail = 0; |
380 | connections[i].keyrequests.head = connections[i].keyrequests.tail = 0; |
380 | connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED; |
381 | connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED; |
381 | connections[i].keyrequest_counter = 0; |
382 | connections[i].keyrequest_counter = 0; |
382 | 383 | ||
383 | if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) { |
384 | if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) { |
384 | /*FIXME: handle error */ |
385 | /*FIXME: handle error */ |
385 | return -1; |
386 | return -1; |
386 | } |
387 | } |
387 | } |
388 | } |
388 | 389 | ||
389 | if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ|PROTO_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, 0 ,0 )) != NULL) { |
390 | if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ|PROTO_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, 0 ,0 )) != NULL) { |
390 | 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) { |
391 | 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) { |
391 | munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows); |
392 | munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows); |
392 | interbuffer = NULL; |
393 | interbuffer = NULL; |
393 | } |
394 | } |
394 | } |
395 | } |
395 | 396 | ||
396 | /* FIXME: save kernel console screen */ |
397 | /* FIXME: save kernel console screen */ |
397 | 398 | ||
398 | async_new_connection(phonehash, 0, NULL, keyboard_events); |
399 | async_new_connection(phonehash, 0, NULL, keyboard_events); |
399 | 400 | ||
400 | sync_send_2(fb_info.phone, FB_CURSOR_GOTO, 0, 0, NULL, NULL); |
401 | sync_send_2(fb_info.phone, FB_CURSOR_GOTO, 0, 0, NULL, NULL); |
401 | nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1); |
402 | nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1); |
402 | 403 | ||
403 | /* Register at NS */ |
404 | /* Register at NS */ |
404 | if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) { |
405 | if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) { |
405 | return -1; |
406 | return -1; |
406 | }; |
407 | }; |
407 | 408 | ||
408 | async_manager(); |
409 | async_manager(); |
409 | 410 | ||
410 | return 0; |
411 | return 0; |
411 | } |
412 | } |
412 | 413 | ||
413 | 414 |