| 1 | /*
|
|---|
| 2 | * Copyright (c) 2006 Josef Cejka
|
|---|
| 3 | * All rights reserved.
|
|---|
| 4 | *
|
|---|
| 5 | * Redistribution and use in source and binary forms, with or without
|
|---|
| 6 | * modification, are permitted provided that the following conditions
|
|---|
| 7 | * are met:
|
|---|
| 8 | *
|
|---|
| 9 | * - Redistributions of source code must retain the above copyright
|
|---|
| 10 | * notice, this list of conditions and the following disclaimer.
|
|---|
| 11 | * - Redistributions in binary form must reproduce the above copyright
|
|---|
| 12 | * notice, this list of conditions and the following disclaimer in the
|
|---|
| 13 | * documentation and/or other materials provided with the distribution.
|
|---|
| 14 | * - The name of the author may not be used to endorse or promote products
|
|---|
| 15 | * derived from this software without specific prior written permission.
|
|---|
| 16 | *
|
|---|
| 17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|---|
| 18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|---|
| 19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|---|
| 20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|---|
| 21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|---|
| 22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|---|
| 23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|---|
| 24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|---|
| 25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|---|
| 26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|---|
| 27 | */
|
|---|
| 28 |
|
|---|
| 29 | /** @addtogroup console
|
|---|
| 30 | * @{
|
|---|
| 31 | */
|
|---|
| 32 | /** @file
|
|---|
| 33 | */
|
|---|
| 34 |
|
|---|
| 35 | #include <libc.h>
|
|---|
| 36 | #include <fb.h>
|
|---|
| 37 | #include <ipc/ipc.h>
|
|---|
| 38 | #include <kbd.h>
|
|---|
| 39 | #include <kbd/keycode.h>
|
|---|
| 40 | #include <ipc/fb.h>
|
|---|
| 41 | #include <ipc/services.h>
|
|---|
| 42 | #include <errno.h>
|
|---|
| 43 | #include <key_buffer.h>
|
|---|
| 44 | #include <ipc/console.h>
|
|---|
| 45 | #include <unistd.h>
|
|---|
| 46 | #include <async.h>
|
|---|
| 47 | #include <libadt/fifo.h>
|
|---|
| 48 | #include <screenbuffer.h>
|
|---|
| 49 | #include <sys/mman.h>
|
|---|
| 50 | #include <stdio.h>
|
|---|
| 51 | #include <string.h>
|
|---|
| 52 | #include <sysinfo.h>
|
|---|
| 53 | #include <event.h>
|
|---|
| 54 |
|
|---|
| 55 | #include "console.h"
|
|---|
| 56 | #include "gcons.h"
|
|---|
| 57 |
|
|---|
| 58 | #define MAX_KEYREQUESTS_BUFFERED 32
|
|---|
| 59 |
|
|---|
| 60 | #define NAME "console"
|
|---|
| 61 |
|
|---|
| 62 | /** Index of currently used virtual console.
|
|---|
| 63 | */
|
|---|
| 64 | int active_console = 0;
|
|---|
| 65 | int prev_console = 0;
|
|---|
| 66 |
|
|---|
| 67 | /** Phone to the keyboard driver. */
|
|---|
| 68 | static int kbd_phone;
|
|---|
| 69 |
|
|---|
| 70 | /** Information about framebuffer */
|
|---|
| 71 | struct {
|
|---|
| 72 | int phone; /**< Framebuffer phone */
|
|---|
| 73 | ipcarg_t rows; /**< Framebuffer rows */
|
|---|
| 74 | ipcarg_t cols; /**< Framebuffer columns */
|
|---|
| 75 | } fb_info;
|
|---|
| 76 |
|
|---|
| 77 | typedef struct {
|
|---|
| 78 | keybuffer_t keybuffer; /**< Buffer for incoming keys. */
|
|---|
| 79 | /** Buffer for unsatisfied request for keys. */
|
|---|
| 80 | FIFO_CREATE_STATIC(keyrequests, ipc_callid_t,
|
|---|
| 81 | MAX_KEYREQUESTS_BUFFERED);
|
|---|
| 82 | int keyrequest_counter; /**< Number of requests in buffer. */
|
|---|
| 83 | int client_phone; /**< Phone to connected client. */
|
|---|
| 84 | int used; /**< 1 if this virtual console is
|
|---|
| 85 | * connected to some client.*/
|
|---|
| 86 | screenbuffer_t screenbuffer; /**< Screenbuffer for saving screen
|
|---|
| 87 | * contents and related settings. */
|
|---|
| 88 | } connection_t;
|
|---|
| 89 |
|
|---|
| 90 | static connection_t connections[CONSOLE_COUNT]; /**< Array of data for virtual
|
|---|
| 91 | * consoles */
|
|---|
| 92 | static keyfield_t *interbuffer = NULL; /**< Pointer to memory shared
|
|---|
| 93 | * with framebufer used for
|
|---|
| 94 | * faster virtual console
|
|---|
| 95 | * switching */
|
|---|
| 96 |
|
|---|
| 97 | /** Information on row-span yet unsent to FB driver. */
|
|---|
| 98 | struct {
|
|---|
| 99 | int row; /**< Row where the span lies. */
|
|---|
| 100 | int col; /**< Leftmost column of the span. */
|
|---|
| 101 | int n; /**< Width of the span. */
|
|---|
| 102 | } fb_pending;
|
|---|
| 103 |
|
|---|
| 104 | /** Size of cwrite_buf. */
|
|---|
| 105 | #define CWRITE_BUF_SIZE 256
|
|---|
| 106 |
|
|---|
| 107 | /** Buffer for receiving data via the CONSOLE_WRITE call from the client. */
|
|---|
| 108 | static char cwrite_buf[CWRITE_BUF_SIZE];
|
|---|
| 109 |
|
|---|
| 110 | static void fb_putchar(wchar_t c, int row, int col);
|
|---|
| 111 |
|
|---|
| 112 |
|
|---|
| 113 | /** Find unused virtual console.
|
|---|
| 114 | *
|
|---|
| 115 | */
|
|---|
| 116 | static int find_free_connection(void)
|
|---|
| 117 | {
|
|---|
| 118 | int i;
|
|---|
| 119 |
|
|---|
| 120 | for (i = 0; i < CONSOLE_COUNT; i++) {
|
|---|
| 121 | if (!connections[i].used)
|
|---|
| 122 | return i;
|
|---|
| 123 | }
|
|---|
| 124 | return -1;
|
|---|
| 125 | }
|
|---|
| 126 |
|
|---|
| 127 | static void clrscr(void)
|
|---|
| 128 | {
|
|---|
| 129 | async_msg_0(fb_info.phone, FB_CLEAR);
|
|---|
| 130 | }
|
|---|
| 131 |
|
|---|
| 132 | static void curs_visibility(bool visible)
|
|---|
| 133 | {
|
|---|
| 134 | async_msg_1(fb_info.phone, FB_CURSOR_VISIBILITY, visible);
|
|---|
| 135 | }
|
|---|
| 136 |
|
|---|
| 137 | static void curs_hide_sync(void)
|
|---|
| 138 | {
|
|---|
| 139 | ipc_call_sync_1_0(fb_info.phone, FB_CURSOR_VISIBILITY, false);
|
|---|
| 140 | }
|
|---|
| 141 |
|
|---|
| 142 | static void curs_goto(int row, int col)
|
|---|
| 143 | {
|
|---|
| 144 | async_msg_2(fb_info.phone, FB_CURSOR_GOTO, row, col);
|
|---|
| 145 | }
|
|---|
| 146 |
|
|---|
| 147 | static void screen_yield(void)
|
|---|
| 148 | {
|
|---|
| 149 | ipc_call_sync_0_0(fb_info.phone, FB_SCREEN_YIELD);
|
|---|
| 150 | }
|
|---|
| 151 |
|
|---|
| 152 | static void screen_reclaim(void)
|
|---|
| 153 | {
|
|---|
| 154 | ipc_call_sync_0_0(fb_info.phone, FB_SCREEN_RECLAIM);
|
|---|
| 155 | }
|
|---|
| 156 |
|
|---|
| 157 | static void kbd_yield(void)
|
|---|
| 158 | {
|
|---|
| 159 | ipc_call_sync_0_0(kbd_phone, KBD_YIELD);
|
|---|
| 160 | }
|
|---|
| 161 |
|
|---|
| 162 | static void kbd_reclaim(void)
|
|---|
| 163 | {
|
|---|
| 164 | ipc_call_sync_0_0(kbd_phone, KBD_RECLAIM);
|
|---|
| 165 | }
|
|---|
| 166 |
|
|---|
| 167 | static void set_style(int style)
|
|---|
| 168 | {
|
|---|
| 169 | async_msg_1(fb_info.phone, FB_SET_STYLE, style);
|
|---|
| 170 | }
|
|---|
| 171 |
|
|---|
| 172 | static void set_color(int fgcolor, int bgcolor, int flags)
|
|---|
| 173 | {
|
|---|
| 174 | async_msg_3(fb_info.phone, FB_SET_COLOR, fgcolor, bgcolor, flags);
|
|---|
| 175 | }
|
|---|
| 176 |
|
|---|
| 177 | static void set_rgb_color(int fgcolor, int bgcolor)
|
|---|
| 178 | {
|
|---|
| 179 | async_msg_2(fb_info.phone, FB_SET_RGB_COLOR, fgcolor, bgcolor);
|
|---|
| 180 | }
|
|---|
| 181 |
|
|---|
| 182 | static void set_attrs(attrs_t *attrs)
|
|---|
| 183 | {
|
|---|
| 184 | switch (attrs->t) {
|
|---|
| 185 | case at_style:
|
|---|
| 186 | set_style(attrs->a.s.style);
|
|---|
| 187 | break;
|
|---|
| 188 |
|
|---|
| 189 | case at_idx:
|
|---|
| 190 | set_color(attrs->a.i.fg_color, attrs->a.i.bg_color,
|
|---|
| 191 | attrs->a.i.flags);
|
|---|
| 192 | break;
|
|---|
| 193 |
|
|---|
| 194 | case at_rgb:
|
|---|
| 195 | set_rgb_color(attrs->a.r.fg_color, attrs->a.r.bg_color);
|
|---|
| 196 | break;
|
|---|
| 197 | }
|
|---|
| 198 | }
|
|---|
| 199 |
|
|---|
| 200 | /** Send an area of screenbuffer to the FB driver. */
|
|---|
| 201 | static void fb_update_area(connection_t *conn, int x, int y, int w, int h)
|
|---|
| 202 | {
|
|---|
| 203 | int i, j;
|
|---|
| 204 | int rc;
|
|---|
| 205 | attrs_t *attrs;
|
|---|
| 206 | keyfield_t *field;
|
|---|
| 207 |
|
|---|
| 208 | if (interbuffer) {
|
|---|
| 209 | for (j = 0; j < h; j++) {
|
|---|
| 210 | for (i = 0; i < w; i++) {
|
|---|
| 211 | interbuffer[i + j * w] =
|
|---|
| 212 | *get_field_at(&conn->screenbuffer,
|
|---|
| 213 | x + i, y + j);
|
|---|
| 214 | }
|
|---|
| 215 | }
|
|---|
| 216 |
|
|---|
| 217 | rc = async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,
|
|---|
| 218 | x, y, w, h);
|
|---|
| 219 | } else {
|
|---|
| 220 | rc = ENOTSUP;
|
|---|
| 221 | }
|
|---|
| 222 |
|
|---|
| 223 | if (rc != 0) {
|
|---|
| 224 | /*
|
|---|
| 225 | attrs = &conn->screenbuffer.attrs;
|
|---|
| 226 |
|
|---|
| 227 | for (j = 0; j < h; j++) {
|
|---|
| 228 | for (i = 0; i < w; i++) {
|
|---|
| 229 | field = get_field_at(&conn->screenbuffer,
|
|---|
| 230 | x + i, y + j);
|
|---|
| 231 | if (!attrs_same(*attrs, field->attrs))
|
|---|
| 232 | set_attrs(&field->attrs);
|
|---|
| 233 | attrs = &field->attrs;
|
|---|
| 234 |
|
|---|
| 235 | fb_putchar(field->character, y + j, x + i);
|
|---|
| 236 | }
|
|---|
| 237 | }*/
|
|---|
| 238 | }
|
|---|
| 239 | }
|
|---|
| 240 |
|
|---|
| 241 | /** Flush pending cells to FB. */
|
|---|
| 242 | static void fb_pending_flush(void)
|
|---|
| 243 | {
|
|---|
| 244 | screenbuffer_t *scr;
|
|---|
| 245 |
|
|---|
| 246 | scr = &(connections[active_console].screenbuffer);
|
|---|
| 247 |
|
|---|
| 248 | if (fb_pending.n > 0) {
|
|---|
| 249 | fb_update_area(&connections[active_console], fb_pending.col,
|
|---|
| 250 | fb_pending.row, fb_pending.n, 1);
|
|---|
| 251 | fb_pending.n = 0;
|
|---|
| 252 | }
|
|---|
| 253 | }
|
|---|
| 254 |
|
|---|
| 255 | /** Mark a character cell as changed.
|
|---|
| 256 | *
|
|---|
| 257 | * This adds the cell to the pending rowspan if possible. Otherwise
|
|---|
| 258 | * the old span is flushed first.
|
|---|
| 259 | */
|
|---|
| 260 | static void cell_mark_changed(int row, int col)
|
|---|
| 261 | {
|
|---|
| 262 | if (fb_pending.n != 0) {
|
|---|
| 263 | if (row != fb_pending.row ||
|
|---|
| 264 | col != fb_pending.col + fb_pending.n) {
|
|---|
| 265 | fb_pending_flush();
|
|---|
| 266 | }
|
|---|
| 267 | }
|
|---|
| 268 |
|
|---|
| 269 | if (fb_pending.n == 0) {
|
|---|
| 270 | fb_pending.row = row;
|
|---|
| 271 | fb_pending.col = col;
|
|---|
| 272 | }
|
|---|
| 273 |
|
|---|
| 274 | ++fb_pending.n;
|
|---|
| 275 | }
|
|---|
| 276 |
|
|---|
| 277 |
|
|---|
| 278 | /** Print a character to the active VC with buffering. */
|
|---|
| 279 | static void fb_putchar(wchar_t c, int row, int col)
|
|---|
| 280 | {
|
|---|
| 281 | async_msg_3(fb_info.phone, FB_PUTCHAR, c, row, col);
|
|---|
| 282 | }
|
|---|
| 283 |
|
|---|
| 284 | /** Process a character from the client (TTY emulation). */
|
|---|
| 285 | static void write_char(int console, wchar_t ch)
|
|---|
| 286 | {
|
|---|
| 287 | bool flush_cursor = false;
|
|---|
| 288 | screenbuffer_t *scr = &(connections[console].screenbuffer);
|
|---|
| 289 |
|
|---|
| 290 | switch (ch) {
|
|---|
| 291 | case '\n':
|
|---|
| 292 | fb_pending_flush();
|
|---|
| 293 | flush_cursor = true;
|
|---|
| 294 | scr->position_y++;
|
|---|
| 295 | scr->position_x = 0;
|
|---|
| 296 | break;
|
|---|
| 297 | case '\r':
|
|---|
| 298 | break;
|
|---|
| 299 | case '\t':
|
|---|
| 300 | scr->position_x += 8;
|
|---|
| 301 | scr->position_x -= scr->position_x % 8;
|
|---|
| 302 | break;
|
|---|
| 303 | case '\b':
|
|---|
| 304 | if (scr->position_x == 0)
|
|---|
| 305 | break;
|
|---|
| 306 | scr->position_x--;
|
|---|
| 307 | if (console == active_console)
|
|---|
| 308 | cell_mark_changed(scr->position_y, scr->position_x);
|
|---|
| 309 | screenbuffer_putchar(scr, ' ');
|
|---|
| 310 | break;
|
|---|
| 311 | default:
|
|---|
| 312 | if (console == active_console)
|
|---|
| 313 | cell_mark_changed(scr->position_y, scr->position_x);
|
|---|
| 314 |
|
|---|
| 315 | screenbuffer_putchar(scr, ch);
|
|---|
| 316 | scr->position_x++;
|
|---|
| 317 | }
|
|---|
| 318 |
|
|---|
| 319 | if (scr->position_x >= scr->size_x) {
|
|---|
| 320 | flush_cursor = true;
|
|---|
| 321 | scr->position_y++;
|
|---|
| 322 | }
|
|---|
| 323 |
|
|---|
| 324 | if (scr->position_y >= scr->size_y) {
|
|---|
| 325 | fb_pending_flush();
|
|---|
| 326 | scr->position_y = scr->size_y - 1;
|
|---|
| 327 | screenbuffer_clear_line(scr, scr->top_line);
|
|---|
| 328 | scr->top_line = (scr->top_line + 1) % scr->size_y;
|
|---|
| 329 | if (console == active_console)
|
|---|
| 330 | async_msg_1(fb_info.phone, FB_SCROLL, 1);
|
|---|
| 331 | }
|
|---|
| 332 |
|
|---|
| 333 | scr->position_x = scr->position_x % scr->size_x;
|
|---|
| 334 |
|
|---|
| 335 | if (console == active_console && flush_cursor)
|
|---|
| 336 | curs_goto(scr->position_y, scr->position_x);
|
|---|
| 337 | }
|
|---|
| 338 |
|
|---|
| 339 | /** Switch to new console */
|
|---|
| 340 | static void change_console(int newcons)
|
|---|
| 341 | {
|
|---|
| 342 | connection_t *conn;
|
|---|
| 343 | int i, j, rc;
|
|---|
| 344 | keyfield_t *field;
|
|---|
| 345 | attrs_t *attrs;
|
|---|
| 346 |
|
|---|
| 347 | if (newcons == active_console)
|
|---|
| 348 | return;
|
|---|
| 349 |
|
|---|
| 350 | fb_pending_flush();
|
|---|
| 351 |
|
|---|
| 352 | if (newcons == KERNEL_CONSOLE) {
|
|---|
| 353 | async_serialize_start();
|
|---|
| 354 | curs_hide_sync();
|
|---|
| 355 | gcons_in_kernel();
|
|---|
| 356 | screen_yield();
|
|---|
| 357 | kbd_yield();
|
|---|
| 358 | async_serialize_end();
|
|---|
| 359 |
|
|---|
| 360 |
|
|---|
| 361 | if (__SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE)) {
|
|---|
| 362 | prev_console = active_console;
|
|---|
| 363 | active_console = KERNEL_CONSOLE;
|
|---|
| 364 | } else
|
|---|
| 365 | newcons = active_console;
|
|---|
| 366 | }
|
|---|
| 367 |
|
|---|
| 368 | if (newcons != KERNEL_CONSOLE) {
|
|---|
| 369 | async_serialize_start();
|
|---|
| 370 |
|
|---|
| 371 | if (active_console == KERNEL_CONSOLE) {
|
|---|
| 372 | screen_reclaim();
|
|---|
| 373 | kbd_reclaim();
|
|---|
| 374 | gcons_redraw_console();
|
|---|
| 375 | }
|
|---|
| 376 |
|
|---|
| 377 | active_console = newcons;
|
|---|
| 378 | gcons_change_console(newcons);
|
|---|
| 379 | conn = &connections[active_console];
|
|---|
| 380 |
|
|---|
| 381 | set_attrs(&conn->screenbuffer.attrs);
|
|---|
| 382 | curs_visibility(false);
|
|---|
| 383 | if (interbuffer) {
|
|---|
| 384 | for (j = 0; j < conn->screenbuffer.size_y; j++) {
|
|---|
| 385 | for (i = 0; i < conn->screenbuffer.size_x; i++) {
|
|---|
| 386 | unsigned int size_x;
|
|---|
| 387 |
|
|---|
| 388 | size_x = conn->screenbuffer.size_x;
|
|---|
| 389 | interbuffer[j * size_x + i] =
|
|---|
| 390 | *get_field_at(&conn->screenbuffer, i, j);
|
|---|
| 391 | }
|
|---|
| 392 | }
|
|---|
| 393 | /* This call can preempt, but we are already at the end */
|
|---|
| 394 | rc = async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,
|
|---|
| 395 | 0, 0, conn->screenbuffer.size_x,
|
|---|
| 396 | conn->screenbuffer.size_y);
|
|---|
| 397 | }
|
|---|
| 398 |
|
|---|
| 399 | if ((!interbuffer) || (rc != 0)) {
|
|---|
| 400 | set_attrs(&conn->screenbuffer.attrs);
|
|---|
| 401 | clrscr();
|
|---|
| 402 | attrs = &conn->screenbuffer.attrs;
|
|---|
| 403 |
|
|---|
| 404 | for (j = 0; j < conn->screenbuffer.size_y; j++)
|
|---|
| 405 | for (i = 0; i < conn->screenbuffer.size_x; i++) {
|
|---|
| 406 | field = get_field_at(&conn->screenbuffer, i, j);
|
|---|
| 407 | if (!attrs_same(*attrs, field->attrs))
|
|---|
| 408 | set_attrs(&field->attrs);
|
|---|
| 409 | attrs = &field->attrs;
|
|---|
| 410 | if ((field->character == ' ') &&
|
|---|
| 411 | (attrs_same(field->attrs,
|
|---|
| 412 | conn->screenbuffer.attrs)))
|
|---|
| 413 | continue;
|
|---|
| 414 |
|
|---|
| 415 | fb_putchar(field->character, j, i);
|
|---|
| 416 | }
|
|---|
| 417 | }
|
|---|
| 418 |
|
|---|
| 419 | curs_goto(conn->screenbuffer.position_y,
|
|---|
| 420 | conn->screenbuffer.position_x);
|
|---|
| 421 | curs_visibility(conn->screenbuffer.is_cursor_visible);
|
|---|
| 422 |
|
|---|
| 423 | async_serialize_end();
|
|---|
| 424 | }
|
|---|
| 425 | }
|
|---|
| 426 |
|
|---|
| 427 | /** Handler for keyboard */
|
|---|
| 428 | static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
|
|---|
| 429 | {
|
|---|
| 430 | ipc_callid_t callid;
|
|---|
| 431 | ipc_call_t call;
|
|---|
| 432 | int retval;
|
|---|
| 433 | kbd_event_t ev;
|
|---|
| 434 | connection_t *conn;
|
|---|
| 435 | int newcon;
|
|---|
| 436 |
|
|---|
| 437 | /* Ignore parameters, the connection is alread opened */
|
|---|
| 438 | while (1) {
|
|---|
| 439 | callid = async_get_call(&call);
|
|---|
| 440 | switch (IPC_GET_METHOD(call)) {
|
|---|
| 441 | case IPC_M_PHONE_HUNGUP:
|
|---|
| 442 | /* TODO: Handle hangup */
|
|---|
| 443 | return;
|
|---|
| 444 | case KBD_MS_LEFT:
|
|---|
| 445 | newcon = gcons_mouse_btn(IPC_GET_ARG1(call));
|
|---|
| 446 | if (newcon != -1)
|
|---|
| 447 | change_console(newcon);
|
|---|
| 448 | retval = 0;
|
|---|
| 449 | break;
|
|---|
| 450 | case KBD_MS_MOVE:
|
|---|
| 451 | gcons_mouse_move(IPC_GET_ARG1(call),
|
|---|
| 452 | IPC_GET_ARG2(call));
|
|---|
| 453 | retval = 0;
|
|---|
| 454 | break;
|
|---|
| 455 | case KBD_EVENT:
|
|---|
| 456 | /* Got event from keyboard driver. */
|
|---|
| 457 | retval = 0;
|
|---|
| 458 | ev.type = IPC_GET_ARG1(call);
|
|---|
| 459 | ev.key = IPC_GET_ARG2(call);
|
|---|
| 460 | ev.mods = IPC_GET_ARG3(call);
|
|---|
| 461 | ev.c = IPC_GET_ARG4(call);
|
|---|
| 462 |
|
|---|
| 463 | /* switch to another virtual console */
|
|---|
| 464 |
|
|---|
| 465 | conn = &connections[active_console];
|
|---|
| 466 |
|
|---|
| 467 | if ((ev.key >= KC_F1) && (ev.key < KC_F1 +
|
|---|
| 468 | CONSOLE_COUNT) && ((ev.mods & KM_CTRL) == 0)) {
|
|---|
| 469 | if (ev.key == KC_F12)
|
|---|
| 470 | change_console(KERNEL_CONSOLE);
|
|---|
| 471 | else
|
|---|
| 472 | change_console(ev.key - KC_F1);
|
|---|
| 473 | break;
|
|---|
| 474 | }
|
|---|
| 475 |
|
|---|
| 476 | /* if client is awaiting key, send it */
|
|---|
| 477 | if (conn->keyrequest_counter > 0) {
|
|---|
| 478 | conn->keyrequest_counter--;
|
|---|
| 479 | ipc_answer_4(fifo_pop(conn->keyrequests), EOK,
|
|---|
| 480 | ev.type, ev.key, ev.mods, ev.c);
|
|---|
| 481 | break;
|
|---|
| 482 | }
|
|---|
| 483 |
|
|---|
| 484 | keybuffer_push(&conn->keybuffer, &ev);
|
|---|
| 485 | retval = 0;
|
|---|
| 486 |
|
|---|
| 487 | break;
|
|---|
| 488 | default:
|
|---|
| 489 | retval = ENOENT;
|
|---|
| 490 | }
|
|---|
| 491 | ipc_answer_0(callid, retval);
|
|---|
| 492 | }
|
|---|
| 493 | }
|
|---|
| 494 |
|
|---|
| 495 | /** Handle CONSOLE_WRITE call. */
|
|---|
| 496 | static void cons_write(int consnum, ipc_callid_t rid, ipc_call_t *request)
|
|---|
| 497 | {
|
|---|
| 498 | ipc_callid_t callid;
|
|---|
| 499 | size_t size;
|
|---|
| 500 | wchar_t ch;
|
|---|
| 501 | size_t off;
|
|---|
| 502 |
|
|---|
| 503 | if (!ipc_data_write_receive(&callid, &size)) {
|
|---|
| 504 | ipc_answer_0(callid, EINVAL);
|
|---|
| 505 | ipc_answer_0(rid, EINVAL);
|
|---|
| 506 | return;
|
|---|
| 507 | }
|
|---|
| 508 |
|
|---|
| 509 | if (size > CWRITE_BUF_SIZE)
|
|---|
| 510 | size = CWRITE_BUF_SIZE;
|
|---|
| 511 |
|
|---|
| 512 | (void) ipc_data_write_finalize(callid, cwrite_buf, size);
|
|---|
| 513 |
|
|---|
| 514 | async_serialize_start();
|
|---|
| 515 |
|
|---|
| 516 | off = 0;
|
|---|
| 517 | while (off < size) {
|
|---|
| 518 | ch = str_decode(cwrite_buf, &off, size);
|
|---|
| 519 | write_char(consnum, ch);
|
|---|
| 520 | }
|
|---|
| 521 |
|
|---|
| 522 | async_serialize_end();
|
|---|
| 523 |
|
|---|
| 524 | gcons_notify_char(consnum);
|
|---|
| 525 | ipc_answer_1(rid, EOK, size);
|
|---|
| 526 | }
|
|---|
| 527 |
|
|---|
| 528 | /** Default thread for new connections */
|
|---|
| 529 | static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
|
|---|
| 530 | {
|
|---|
| 531 | ipc_callid_t callid;
|
|---|
| 532 | ipc_call_t call;
|
|---|
| 533 | int consnum;
|
|---|
| 534 | ipcarg_t arg1, arg2, arg3, arg4;
|
|---|
| 535 | connection_t *conn;
|
|---|
| 536 | screenbuffer_t *scr;
|
|---|
| 537 |
|
|---|
| 538 | if ((consnum = find_free_connection()) == -1) {
|
|---|
| 539 | ipc_answer_0(iid, ELIMIT);
|
|---|
| 540 | return;
|
|---|
| 541 | }
|
|---|
| 542 | conn = &connections[consnum];
|
|---|
| 543 | conn->used = 1;
|
|---|
| 544 |
|
|---|
| 545 | async_serialize_start();
|
|---|
| 546 | gcons_notify_connect(consnum);
|
|---|
| 547 | conn->client_phone = IPC_GET_ARG5(*icall);
|
|---|
| 548 | screenbuffer_clear(&conn->screenbuffer);
|
|---|
| 549 | if (consnum == active_console)
|
|---|
| 550 | clrscr();
|
|---|
| 551 |
|
|---|
| 552 | /* Accept the connection */
|
|---|
| 553 | ipc_answer_0(iid, EOK);
|
|---|
| 554 |
|
|---|
| 555 | while (1) {
|
|---|
| 556 | async_serialize_end();
|
|---|
| 557 | callid = async_get_call(&call);
|
|---|
| 558 | async_serialize_start();
|
|---|
| 559 |
|
|---|
| 560 | arg1 = 0;
|
|---|
| 561 | arg2 = 0;
|
|---|
| 562 | arg3 = 0;
|
|---|
| 563 | arg4 = 0;
|
|---|
| 564 |
|
|---|
| 565 | switch (IPC_GET_METHOD(call)) {
|
|---|
| 566 | case IPC_M_PHONE_HUNGUP:
|
|---|
| 567 | gcons_notify_disconnect(consnum);
|
|---|
| 568 |
|
|---|
| 569 | /* Answer all pending requests */
|
|---|
| 570 | while (conn->keyrequest_counter > 0) {
|
|---|
| 571 | conn->keyrequest_counter--;
|
|---|
| 572 | ipc_answer_0(fifo_pop(conn->keyrequests),
|
|---|
| 573 | ENOENT);
|
|---|
| 574 | break;
|
|---|
| 575 | }
|
|---|
| 576 | conn->used = 0;
|
|---|
| 577 | return;
|
|---|
| 578 | case CONSOLE_PUTCHAR:
|
|---|
| 579 | write_char(consnum, IPC_GET_ARG1(call));
|
|---|
| 580 | gcons_notify_char(consnum);
|
|---|
| 581 | break;
|
|---|
| 582 | case CONSOLE_WRITE:
|
|---|
| 583 | async_serialize_end();
|
|---|
| 584 | cons_write(consnum, callid, &call);
|
|---|
| 585 | async_serialize_start();
|
|---|
| 586 | continue;
|
|---|
| 587 | case CONSOLE_CLEAR:
|
|---|
| 588 | /* Send message to fb */
|
|---|
| 589 | if (consnum == active_console) {
|
|---|
| 590 | async_msg_0(fb_info.phone, FB_CLEAR);
|
|---|
| 591 | }
|
|---|
| 592 |
|
|---|
| 593 | screenbuffer_clear(&conn->screenbuffer);
|
|---|
| 594 |
|
|---|
| 595 | break;
|
|---|
| 596 | case CONSOLE_GOTO:
|
|---|
| 597 | screenbuffer_goto(&conn->screenbuffer,
|
|---|
| 598 | IPC_GET_ARG2(call), IPC_GET_ARG1(call));
|
|---|
| 599 | if (consnum == active_console)
|
|---|
| 600 | curs_goto(IPC_GET_ARG1(call),
|
|---|
| 601 | IPC_GET_ARG2(call));
|
|---|
| 602 | break;
|
|---|
| 603 | case CONSOLE_GETSIZE:
|
|---|
| 604 | arg1 = fb_info.rows;
|
|---|
| 605 | arg2 = fb_info.cols;
|
|---|
| 606 | break;
|
|---|
| 607 | case CONSOLE_FLUSH:
|
|---|
| 608 | fb_pending_flush();
|
|---|
| 609 | if (consnum == active_console) {
|
|---|
| 610 | async_req_0_0(fb_info.phone, FB_FLUSH);
|
|---|
| 611 |
|
|---|
| 612 | scr = &(connections[consnum].screenbuffer);
|
|---|
| 613 | curs_goto(scr->position_y, scr->position_x);
|
|---|
| 614 | }
|
|---|
| 615 | break;
|
|---|
| 616 | case CONSOLE_SET_STYLE:
|
|---|
| 617 | fb_pending_flush();
|
|---|
| 618 | arg1 = IPC_GET_ARG1(call);
|
|---|
| 619 | screenbuffer_set_style(&conn->screenbuffer, arg1);
|
|---|
| 620 | if (consnum == active_console)
|
|---|
| 621 | set_style(arg1);
|
|---|
| 622 | break;
|
|---|
| 623 | case CONSOLE_SET_COLOR:
|
|---|
| 624 | fb_pending_flush();
|
|---|
| 625 | arg1 = IPC_GET_ARG1(call);
|
|---|
| 626 | arg2 = IPC_GET_ARG2(call);
|
|---|
| 627 | arg3 = IPC_GET_ARG3(call);
|
|---|
| 628 | screenbuffer_set_color(&conn->screenbuffer, arg1,
|
|---|
| 629 | arg2, arg3);
|
|---|
| 630 | if (consnum == active_console)
|
|---|
| 631 | set_color(arg1, arg2, arg3);
|
|---|
| 632 | break;
|
|---|
| 633 | case CONSOLE_SET_RGB_COLOR:
|
|---|
| 634 | fb_pending_flush();
|
|---|
| 635 | arg1 = IPC_GET_ARG1(call);
|
|---|
| 636 | arg2 = IPC_GET_ARG2(call);
|
|---|
| 637 | screenbuffer_set_rgb_color(&conn->screenbuffer, arg1,
|
|---|
| 638 | arg2);
|
|---|
| 639 | if (consnum == active_console)
|
|---|
| 640 | set_rgb_color(arg1, arg2);
|
|---|
| 641 | break;
|
|---|
| 642 | case CONSOLE_CURSOR_VISIBILITY:
|
|---|
| 643 | fb_pending_flush();
|
|---|
| 644 | arg1 = IPC_GET_ARG1(call);
|
|---|
| 645 | conn->screenbuffer.is_cursor_visible = arg1;
|
|---|
| 646 | if (consnum == active_console)
|
|---|
| 647 | curs_visibility(arg1);
|
|---|
| 648 | break;
|
|---|
| 649 | case CONSOLE_GETKEY:
|
|---|
| 650 | if (keybuffer_empty(&conn->keybuffer)) {
|
|---|
| 651 | /* buffer is empty -> store request */
|
|---|
| 652 | if (conn->keyrequest_counter <
|
|---|
| 653 | MAX_KEYREQUESTS_BUFFERED) {
|
|---|
| 654 | fifo_push(conn->keyrequests, callid);
|
|---|
| 655 | conn->keyrequest_counter++;
|
|---|
| 656 | } else {
|
|---|
| 657 | /*
|
|---|
| 658 | * No key available and too many
|
|---|
| 659 | * requests => fail.
|
|---|
| 660 | */
|
|---|
| 661 | ipc_answer_0(callid, ELIMIT);
|
|---|
| 662 | }
|
|---|
| 663 | continue;
|
|---|
| 664 | }
|
|---|
| 665 | kbd_event_t ev;
|
|---|
| 666 | keybuffer_pop(&conn->keybuffer, &ev);
|
|---|
| 667 | arg1 = ev.type;
|
|---|
| 668 | arg2 = ev.key;
|
|---|
| 669 | arg3 = ev.mods;
|
|---|
| 670 | arg4 = ev.c;
|
|---|
| 671 | break;
|
|---|
| 672 | case CONSOLE_KCON_ENABLE:
|
|---|
| 673 | change_console(KERNEL_CONSOLE);
|
|---|
| 674 | break;
|
|---|
| 675 | }
|
|---|
| 676 | ipc_answer_4(callid, EOK, arg1, arg2, arg3, arg4);
|
|---|
| 677 | }
|
|---|
| 678 | }
|
|---|
| 679 |
|
|---|
| 680 | static void interrupt_received(ipc_callid_t callid, ipc_call_t *call)
|
|---|
| 681 | {
|
|---|
| 682 | change_console(prev_console);
|
|---|
| 683 | }
|
|---|
| 684 |
|
|---|
| 685 | int main(int argc, char *argv[])
|
|---|
| 686 | {
|
|---|
| 687 | printf(NAME ": HelenOS Console service\n");
|
|---|
| 688 |
|
|---|
| 689 | ipcarg_t phonehash;
|
|---|
| 690 | size_t ib_size;
|
|---|
| 691 | int i;
|
|---|
| 692 |
|
|---|
| 693 | async_set_client_connection(client_connection);
|
|---|
| 694 |
|
|---|
| 695 | /* Connect to keyboard driver */
|
|---|
| 696 | kbd_phone = ipc_connect_me_to_blocking(PHONE_NS, SERVICE_KEYBOARD, 0, 0);
|
|---|
| 697 | if (kbd_phone < 0) {
|
|---|
| 698 | printf(NAME ": Failed to connect to keyboard service\n");
|
|---|
| 699 | return -1;
|
|---|
| 700 | }
|
|---|
| 701 |
|
|---|
| 702 | if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, 0, &phonehash) != 0) {
|
|---|
| 703 | printf(NAME ": Failed to create callback from keyboard service\n");
|
|---|
| 704 | return -1;
|
|---|
| 705 | }
|
|---|
| 706 |
|
|---|
| 707 | async_new_connection(phonehash, 0, NULL, keyboard_events);
|
|---|
| 708 |
|
|---|
| 709 | /* Connect to framebuffer driver */
|
|---|
| 710 | fb_info.phone = ipc_connect_me_to_blocking(PHONE_NS, SERVICE_VIDEO, 0, 0);
|
|---|
| 711 | if (fb_info.phone < 0) {
|
|---|
| 712 | printf(NAME ": Failed to connect to video service\n");
|
|---|
| 713 | return -1;
|
|---|
| 714 | }
|
|---|
| 715 |
|
|---|
| 716 | /* Disable kernel output to the console */
|
|---|
| 717 | __SYSCALL0(SYS_DEBUG_DISABLE_CONSOLE);
|
|---|
| 718 |
|
|---|
| 719 | /* Initialize gcons */
|
|---|
| 720 | gcons_init(fb_info.phone);
|
|---|
| 721 | /* Synchronize, the gcons can have something in queue */
|
|---|
| 722 | async_req_0_0(fb_info.phone, FB_FLUSH);
|
|---|
| 723 |
|
|---|
| 724 | async_req_0_2(fb_info.phone, FB_GET_CSIZE, &fb_info.rows,
|
|---|
| 725 | &fb_info.cols);
|
|---|
| 726 | set_rgb_color(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
|
|---|
| 727 | clrscr();
|
|---|
| 728 |
|
|---|
| 729 | /* Init virtual consoles */
|
|---|
| 730 | for (i = 0; i < CONSOLE_COUNT; i++) {
|
|---|
| 731 | connections[i].used = 0;
|
|---|
| 732 | keybuffer_init(&connections[i].keybuffer);
|
|---|
| 733 |
|
|---|
| 734 | connections[i].keyrequests.head = 0;
|
|---|
| 735 | connections[i].keyrequests.tail = 0;
|
|---|
| 736 | connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED;
|
|---|
| 737 | connections[i].keyrequest_counter = 0;
|
|---|
| 738 |
|
|---|
| 739 | if (screenbuffer_init(&connections[i].screenbuffer,
|
|---|
| 740 | fb_info.cols, fb_info.rows) == NULL) {
|
|---|
| 741 | /* FIXME: handle error */
|
|---|
| 742 | return -1;
|
|---|
| 743 | }
|
|---|
| 744 | }
|
|---|
| 745 | connections[KERNEL_CONSOLE].used = 1;
|
|---|
| 746 |
|
|---|
| 747 | /* Set up shared memory buffer. */
|
|---|
| 748 | ib_size = sizeof(keyfield_t) * fb_info.cols * fb_info.rows;
|
|---|
| 749 | interbuffer = as_get_mappable_page(ib_size);
|
|---|
| 750 |
|
|---|
| 751 | fb_pending.n = 0;
|
|---|
| 752 |
|
|---|
| 753 | if (as_area_create(interbuffer, ib_size, AS_AREA_READ |
|
|---|
| 754 | AS_AREA_WRITE | AS_AREA_CACHEABLE) != interbuffer) {
|
|---|
| 755 | interbuffer = NULL;
|
|---|
| 756 | }
|
|---|
| 757 |
|
|---|
| 758 | if (interbuffer) {
|
|---|
| 759 | if (ipc_share_out_start(fb_info.phone, interbuffer,
|
|---|
| 760 | AS_AREA_READ) != EOK) {
|
|---|
| 761 | as_area_destroy(interbuffer);
|
|---|
| 762 | interbuffer = NULL;
|
|---|
| 763 | }
|
|---|
| 764 | }
|
|---|
| 765 |
|
|---|
| 766 | curs_goto(0, 0);
|
|---|
| 767 | curs_visibility(
|
|---|
| 768 | connections[active_console].screenbuffer.is_cursor_visible);
|
|---|
| 769 |
|
|---|
| 770 | /* Register at NS */
|
|---|
| 771 | if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, 0, &phonehash) != 0)
|
|---|
| 772 | return -1;
|
|---|
| 773 |
|
|---|
| 774 | /* Receive kernel notifications */
|
|---|
| 775 | if (event_subscribe(EVENT_KCONSOLE, 0) != EOK)
|
|---|
| 776 | printf(NAME ": Error registering kconsole notifications\n");
|
|---|
| 777 |
|
|---|
| 778 | async_set_interrupt_received(interrupt_received);
|
|---|
| 779 |
|
|---|
| 780 | // FIXME: avoid connectiong to itself, keep using klog
|
|---|
| 781 | // printf(NAME ": Accepting connections\n");
|
|---|
| 782 | async_manager();
|
|---|
| 783 |
|
|---|
| 784 | return 0;
|
|---|
| 785 | }
|
|---|
| 786 |
|
|---|
| 787 | /** @}
|
|---|
| 788 | */
|
|---|