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