/* ofconsole.c -- Open Firmware console for GRUB. */ /* * GRUB -- GRand Unified Bootloader * Copyright (C) 2003, 2004 Free Software Foundation, Inc. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ #include #include #include #include #include static grub_ieee1275_ihandle_t stdout_ihandle; static grub_ieee1275_ihandle_t stdin_ihandle; static int grub_curr_x; static int grub_curr_y; static int grub_keybuf; static int grub_buflen; struct color { int red; int green; int blue; }; #define MAX 0xff static struct color colors[8] = { { 0, 0, 0}, { MAX, 0, 0}, { 0, MAX, 0}, { MAX, MAX, 0}, { 0, 0, MAX}, { MAX, 0, MAX}, { 0, MAX, MAX}, { MAX, MAX, MAX} }; static int fgcolor = 7; static int bgcolor = 0; /* Write control characters to the console. */ static void grub_ofconsole_writeesc (const char *str) { while (*str) { char chr = *(str++); grub_ieee1275_write (stdout_ihandle, &chr, 1, 0); } } static void grub_ofconsole_putchar (grub_uint32_t c) { char chr = c; if (c == '\n') { grub_curr_y++; grub_curr_x = 0; } else grub_curr_x++; grub_ieee1275_write (stdout_ihandle, &chr, 1, 0); } static void grub_ofconsole_setcolorstate (grub_term_color_state state) { char setcol[20]; int fg; int bg; switch (state) { case GRUB_TERM_COLOR_STANDARD: case GRUB_TERM_COLOR_NORMAL: fg = fgcolor; bg = bgcolor; break; case GRUB_TERM_COLOR_HIGHLIGHT: fg = bgcolor; bg = fgcolor; break; default: return; } grub_sprintf (setcol, "\e[3%dm\e[4%dm", fg, bg); grub_ofconsole_writeesc (setcol); } static void grub_ofconsole_setcolor (grub_uint8_t normal_color, grub_uint8_t highlight_color) { fgcolor = normal_color; bgcolor = highlight_color; } static int grub_ofconsole_readkey (int *key) { char c; int actual = 0; grub_ieee1275_read (stdin_ihandle, &c, 1, &actual); if (actual && c == '\e') { grub_ieee1275_read (stdin_ihandle, &c, 1, &actual); if (! actual) { *key = '\e'; return 1; } if (c != 91) return 0; grub_ieee1275_read (stdin_ihandle, &c, 1, &actual); if (! actual) return 0; switch (c) { case 65: /* Up: Ctrl-p. */ c = 16; break; case 66: /* Down: Ctrl-n. */ c = 14; break; case 67: /* Right: Ctrl-f. */ c = 6; break; case 68: /* Left: Ctrl-b. */ c = 2; break; } } *key = c; return actual; } static int grub_ofconsole_checkkey (void) { int key; int read; if (grub_buflen) return 1; read = grub_ofconsole_readkey (&key); if (read) { grub_keybuf = key; grub_buflen = 1; return 1; } return 0; } static int grub_ofconsole_getkey (void) { int key; if (grub_buflen) { grub_buflen =0; return grub_keybuf; } while (! grub_ofconsole_readkey (&key)); return key; } static grub_uint16_t grub_ofconsole_getxy (void) { return ((grub_curr_x - 1) << 8) | grub_curr_y; } static void grub_ofconsole_gotoxy (grub_uint8_t x, grub_uint8_t y) { char s[11]; /* 5 + 3 + 3. */ grub_curr_x = x; grub_curr_y = y; grub_sprintf (s, "\e[%d;%dH", y + 1, x + 1); grub_ofconsole_writeesc (s); } static void grub_ofconsole_cls (void) { /* Clear the screen. */ grub_ofconsole_writeesc (" "); } static void grub_ofconsole_setcursor (int on __attribute ((unused))) { /* XXX: Not supported. */ } static void grub_ofconsole_refresh (void) { /* Do nothing, the current console state is ok. */ } static grub_err_t grub_ofconsole_init (void) { grub_ieee1275_phandle_t chosen; char data[4]; grub_size_t actual; int col; if (grub_ieee1275_finddevice ("/chosen", &chosen)) return grub_error (GRUB_ERR_UNKNOWN_DEVICE, "Cannot find /chosen"); if (grub_ieee1275_get_property (chosen, "stdout", data, sizeof data, &actual) || actual != sizeof data) return grub_error (GRUB_ERR_UNKNOWN_DEVICE, "Cannot find stdout"); stdout_ihandle = grub_ieee1275_decode_int_4 (data); if (grub_ieee1275_get_property (chosen, "stdin", data, sizeof data, &actual) || actual != sizeof data) return grub_error (GRUB_ERR_UNKNOWN_DEVICE, "Cannot find stdin"); stdin_ihandle = grub_ieee1275_decode_int_4 (data); /* Initialize colors. */ for (col = 0; col < 7; col++) grub_ieee1275_set_color (stdout_ihandle, col, colors[col].red, colors[col].green, colors[col].blue); /* Set the right fg and bg colors. */ grub_ofconsole_setcolorstate (GRUB_TERM_COLOR_NORMAL); return 0; } static grub_err_t grub_ofconsole_fini (void) { return 0; } static struct grub_term grub_ofconsole_term = { .name = "ofconsole", .init = grub_ofconsole_init, .fini = grub_ofconsole_fini, .putchar = grub_ofconsole_putchar, .checkkey = grub_ofconsole_checkkey, .getkey = grub_ofconsole_getkey, .getxy = grub_ofconsole_getxy, .gotoxy = grub_ofconsole_gotoxy, .cls = grub_ofconsole_cls, .setcolorstate = grub_ofconsole_setcolorstate, .setcolor = grub_ofconsole_setcolor, .setcursor = grub_ofconsole_setcursor, .refresh = grub_ofconsole_refresh, .flags = 0, .next = 0 }; void grub_console_init (void) { grub_term_register (&grub_ofconsole_term); grub_term_set_current (&grub_ofconsole_term); }