263 lines
7.7 KiB
C
263 lines
7.7 KiB
C
/* console.c -- Open Firmware console for VAS_EBOOT. */
|
||
/*
|
||
* VAS_EBOOT -- GRand Unified Bootloader
|
||
* Copyright (C) 2003,2004,2005,2007,2008,2009 Free Software Foundation, Inc.
|
||
*
|
||
* VAS_EBOOT 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 3 of the License, or
|
||
* (at your option) any later version.
|
||
*
|
||
* VAS_EBOOT 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 VAS_EBOOT. If not, see <http://www.gnu.org/licenses/>.
|
||
*/
|
||
|
||
#include <VasEBoot/term.h>
|
||
#include <VasEBoot/types.h>
|
||
#include <VasEBoot/misc.h>
|
||
#include <VasEBoot/mm.h>
|
||
#include <VasEBoot/time.h>
|
||
#include <VasEBoot/terminfo.h>
|
||
#include <VasEBoot/ieee1275/console.h>
|
||
#include <VasEBoot/ieee1275/ieee1275.h>
|
||
|
||
static VasEBoot_ieee1275_ihandle_t stdout_ihandle;
|
||
static VasEBoot_ieee1275_ihandle_t stdin_ihandle;
|
||
|
||
extern struct VasEBoot_terminfo_output_state VasEBoot_console_terminfo_output;
|
||
|
||
struct color
|
||
{
|
||
int red;
|
||
int green;
|
||
int blue;
|
||
};
|
||
|
||
/* Use serial colors as they are default on most firmwares and some firmwares
|
||
ignore set-color!. Additionally output may be redirected to serial. */
|
||
static struct color colors[] =
|
||
{
|
||
// {R, G, B}
|
||
{0x00, 0x00, 0x00}, // 0 = black
|
||
{0xA8, 0x00, 0x00}, // 1 = red
|
||
{0x00, 0xA8, 0x00}, // 2 = green
|
||
{0xFE, 0xFE, 0x54}, // 3 = yellow
|
||
{0x00, 0x00, 0xA8}, // 4 = blue
|
||
{0xA8, 0x00, 0xA8}, // 5 = magenta
|
||
{0x00, 0xA8, 0xA8}, // 6 = cyan
|
||
{0xFE, 0xFE, 0xFE} // 7 = white
|
||
};
|
||
|
||
static void
|
||
put (struct VasEBoot_term_output *term __attribute__ ((unused)), const int c)
|
||
{
|
||
char chr = c;
|
||
|
||
VasEBoot_ieee1275_write (stdout_ihandle, &chr, 1, 0);
|
||
}
|
||
|
||
static int
|
||
readkey (struct VasEBoot_term_input *term __attribute__ ((unused)))
|
||
{
|
||
VasEBoot_uint8_t c;
|
||
VasEBoot_ssize_t actual = 0;
|
||
|
||
VasEBoot_ieee1275_read (stdin_ihandle, &c, 1, &actual);
|
||
if (actual > 0)
|
||
return c;
|
||
return -1;
|
||
}
|
||
|
||
static void
|
||
VasEBoot_console_dimensions (void)
|
||
{
|
||
VasEBoot_ieee1275_ihandle_t options;
|
||
VasEBoot_ieee1275_phandle_t stdout_phandle;
|
||
char val[1024];
|
||
|
||
/* Always assume 80x24 on serial since screen-#rows/screen-#columns is often
|
||
garbage for such devices. */
|
||
if (! VasEBoot_ieee1275_instance_to_package (stdout_ihandle,
|
||
&stdout_phandle)
|
||
&& ! VasEBoot_ieee1275_package_to_path (stdout_phandle,
|
||
val, sizeof (val) - 1, 0))
|
||
{
|
||
VasEBoot_ieee1275_ihandle_t stdout_options;
|
||
val[sizeof (val) - 1] = 0;
|
||
|
||
if (! VasEBoot_ieee1275_finddevice (val, &stdout_options)
|
||
&& ! VasEBoot_ieee1275_get_property (stdout_options, "device_type",
|
||
val, sizeof (val) - 1, 0))
|
||
{
|
||
val[sizeof (val) - 1] = 0;
|
||
if (VasEBoot_strcmp (val, "serial") == 0)
|
||
{
|
||
VasEBoot_console_terminfo_output.size.x = 80;
|
||
VasEBoot_console_terminfo_output.size.y = 24;
|
||
return;
|
||
}
|
||
}
|
||
}
|
||
|
||
if (! VasEBoot_ieee1275_finddevice ("/options", &options)
|
||
&& options != (VasEBoot_ieee1275_ihandle_t) -1)
|
||
{
|
||
if (! VasEBoot_ieee1275_get_property (options, "screen-#columns",
|
||
val, sizeof (val) - 1, 0))
|
||
{
|
||
val[sizeof (val) - 1] = 0;
|
||
VasEBoot_console_terminfo_output.size.x
|
||
= (VasEBoot_uint8_t) VasEBoot_strtoul (val, 0, 10);
|
||
}
|
||
if (! VasEBoot_ieee1275_get_property (options, "screen-#rows",
|
||
val, sizeof (val) - 1, 0))
|
||
{
|
||
val[sizeof (val) - 1] = 0;
|
||
VasEBoot_console_terminfo_output.size.y
|
||
= (VasEBoot_uint8_t) VasEBoot_strtoul (val, 0, 10);
|
||
}
|
||
}
|
||
|
||
/* Bogus default value on SLOF in QEMU. */
|
||
if (VasEBoot_console_terminfo_output.size.x == 200
|
||
&& VasEBoot_console_terminfo_output.size.y == 200)
|
||
{
|
||
VasEBoot_console_terminfo_output.size.x = 80;
|
||
VasEBoot_console_terminfo_output.size.y = 24;
|
||
}
|
||
|
||
/* Use a small console by default. */
|
||
if (! VasEBoot_console_terminfo_output.size.x)
|
||
VasEBoot_console_terminfo_output.size.x = 80;
|
||
if (! VasEBoot_console_terminfo_output.size.y)
|
||
VasEBoot_console_terminfo_output.size.y = 24;
|
||
}
|
||
|
||
static void
|
||
VasEBoot_console_setcursor (struct VasEBoot_term_output *term,
|
||
int on)
|
||
{
|
||
VasEBoot_terminfo_setcursor (term, on);
|
||
|
||
if (!VasEBoot_ieee1275_test_flag (VAS_EBOOT_IEEE1275_FLAG_HAS_CURSORONOFF))
|
||
return;
|
||
|
||
/* Understood by the Open Firmware flavour in OLPC. */
|
||
if (on)
|
||
VasEBoot_ieee1275_interpret ("cursor-on", 0);
|
||
else
|
||
VasEBoot_ieee1275_interpret ("cursor-off", 0);
|
||
}
|
||
|
||
static VasEBoot_err_t
|
||
VasEBoot_console_init_input (struct VasEBoot_term_input *term)
|
||
{
|
||
VasEBoot_ssize_t actual;
|
||
|
||
if (VasEBoot_ieee1275_get_integer_property (VasEBoot_ieee1275_chosen, "stdin", &stdin_ihandle,
|
||
sizeof stdin_ihandle, &actual)
|
||
|| actual != sizeof stdin_ihandle)
|
||
return VasEBoot_error (VAS_EBOOT_ERR_UNKNOWN_DEVICE, "cannot find stdin");
|
||
|
||
return VasEBoot_terminfo_input_init (term);
|
||
}
|
||
|
||
static VasEBoot_err_t
|
||
VasEBoot_console_init_output (struct VasEBoot_term_output *term)
|
||
{
|
||
VasEBoot_ssize_t actual;
|
||
unsigned int col;
|
||
|
||
/* The latest PowerMacs don't actually initialize the screen for us, so we
|
||
* use this trick to re-open the output device (but we avoid doing this on
|
||
* platforms where it's known to be broken). */
|
||
if (! VasEBoot_ieee1275_test_flag (VAS_EBOOT_IEEE1275_FLAG_BROKEN_OUTPUT))
|
||
VasEBoot_ieee1275_interpret ("output-device output", 0);
|
||
|
||
if (VasEBoot_ieee1275_get_integer_property (VasEBoot_ieee1275_chosen, "stdout", &stdout_ihandle,
|
||
sizeof stdout_ihandle, &actual)
|
||
|| actual != sizeof stdout_ihandle)
|
||
return VasEBoot_error (VAS_EBOOT_ERR_UNKNOWN_DEVICE, "cannot find stdout");
|
||
|
||
/* Initialize colors. */
|
||
for (col = 0; col < ARRAY_SIZE (colors); col++)
|
||
VasEBoot_ieee1275_set_color (stdout_ihandle, col, colors[col].red,
|
||
colors[col].green, colors[col].blue);
|
||
|
||
/* Set the right fg and bg colors. */
|
||
VasEBoot_terminfo_setcolorstate (term, VAS_EBOOT_TERM_COLOR_NORMAL);
|
||
|
||
VasEBoot_console_dimensions ();
|
||
|
||
VasEBoot_terminfo_output_init (term);
|
||
|
||
return 0;
|
||
}
|
||
|
||
|
||
|
||
struct VasEBoot_terminfo_input_state VasEBoot_console_terminfo_input =
|
||
{
|
||
.readkey = readkey
|
||
};
|
||
|
||
struct VasEBoot_terminfo_output_state VasEBoot_console_terminfo_output =
|
||
{
|
||
.put = put,
|
||
.size = { 80, 24 }
|
||
};
|
||
|
||
static struct VasEBoot_term_input VasEBoot_console_term_input =
|
||
{
|
||
.name = "console",
|
||
.init = VasEBoot_console_init_input,
|
||
.getkey = VasEBoot_terminfo_getkey,
|
||
.data = &VasEBoot_console_terminfo_input
|
||
};
|
||
|
||
static struct VasEBoot_term_output VasEBoot_console_term_output =
|
||
{
|
||
.name = "console",
|
||
.init = VasEBoot_console_init_output,
|
||
.putchar = VasEBoot_terminfo_putchar,
|
||
.getxy = VasEBoot_terminfo_getxy,
|
||
.getwh = VasEBoot_terminfo_getwh,
|
||
.gotoxy = VasEBoot_terminfo_gotoxy,
|
||
.cls = VasEBoot_terminfo_cls,
|
||
.setcolorstate = VasEBoot_terminfo_setcolorstate,
|
||
.setcursor = VasEBoot_console_setcursor,
|
||
.flags = VAS_EBOOT_TERM_CODE_TYPE_ASCII,
|
||
.data = &VasEBoot_console_terminfo_output,
|
||
.progress_update_divisor = VAS_EBOOT_PROGRESS_FAST
|
||
};
|
||
|
||
void
|
||
VasEBoot_console_init_early (void)
|
||
{
|
||
VasEBoot_term_register_input ("console", &VasEBoot_console_term_input);
|
||
VasEBoot_term_register_output ("console", &VasEBoot_console_term_output);
|
||
}
|
||
|
||
void
|
||
VasEBoot_console_init_lately (void)
|
||
{
|
||
const char *type;
|
||
|
||
if (VasEBoot_ieee1275_test_flag (VAS_EBOOT_IEEE1275_FLAG_CURSORONOFF_ANSI_BROKEN))
|
||
type = "ieee1275-nocursor";
|
||
else
|
||
type = "ieee1275";
|
||
VasEBoot_terminfo_init ();
|
||
VasEBoot_terminfo_output_register (&VasEBoot_console_term_output, type);
|
||
}
|
||
|
||
void
|
||
VasEBoot_console_fini (void)
|
||
{
|
||
}
|