arm_pl011_context pl011_context;
rpi_fb_context fb_context;
char uart_instance[20];
static void output_char_serial(char c)
{
arm_pl011_write_polled(&pl011_context.base, c);
}
void output_char_fb(char c)
{
fbcons_write_polled(&fb_context.base, c);
}
static void *get_reg_of_node(const void *fdt, int node)
{
int len;
const uint32_t *val;
val = fdt_getprop(fdt, node, "reg", &len);
if (val == NULL || len < 4) {
return NULL;
}
return (void *) fdt32_to_cpu(val[0]);
}
static void arm_pl011_init_ctx(
const void *fdt,
const char *serial
)
{
arm_pl011_context *ctx = &pl011_context;
int node;
if (strcmp(serial, "uart0") == 0) {
rtems_termios_device_context_initialize(&ctx->base, "UART");
node = fdt_path_offset(fdt, serial);
ctx->regs = get_reg_of_node(fdt, node);
}
}
static void console_select( const char *console )
{
const char *opt;
opt = rpi_cmdline_get_arg("--console=");
if ( opt ) {
if ( strncmp( opt, "fbcons", sizeof( "fbcons" ) - 1 ) == 0 ) {
if ( rpi_video_is_initialized() > 0 ) {
strcpy(uart_instance, "/dev/fbcons");
BSP_output_char = output_char_fb;
}
}else{
if ( console == NULL ){
bsp_fatal( BSP_FATAL_CONSOLE_NO_DEV );
}
BSP_output_char = output_char_serial;
strcpy(uart_instance, "/dev/ttyS0");
}
}
}
static void uart_probe(void)
{
const void *fdt;
const char *console;
int node;
fdt = bsp_fdt_get();
node = fdt_path_offset(fdt, "/chosen");
console = fdt_getprop(fdt, node, "stdout-path", NULL);
node = fdt_path_offset(fdt, "/aliases");
int offset = fdt_first_property_offset(fdt, node);
while (offset >= 0) {
const struct fdt_property *prop;
prop = fdt_get_property_by_offset(fdt, offset, NULL);
if (prop != NULL) {
const char *name;
name = fdt_string(fdt, fdt32_to_cpu(prop->nameoff));
if(strstr(name, "serial") != NULL) {
const char *serial;
serial = prop->data;
arm_pl011_init_ctx(fdt, serial);
}
}
offset = fdt_next_property_offset(fdt, offset);
}
console_select(console);
}
static void output_char(char c)
{
uart_probe();
(*BSP_output_char)(c);
}
rtems_status_code console_initialize(
rtems_device_major_number major,
rtems_device_minor_number minor,
void *arg
)
{
rtems_termios_initialize();
rtems_termios_device_install(
"/dev/ttyS0",
&arm_pl011_fns,
NULL,
&pl011_context.base
);
rtems_termios_device_install(
"/dev/fbcons",
&fbcons_fns,
NULL,
&fb_context.base);
link(uart_instance, CONSOLE_DEVICE_NAME);
return RTEMS_SUCCESSFUL;
}
BSP_output_char_function_type BSP_output_char = output_char;
BSP_polling_getchar_function_type BSP_poll_char = NULL;
RTEMS_SYSINIT_ITEM(
uart_probe,
RTEMS_SYSINIT_BSP_START,
RTEMS_SYSINIT_ORDER_LAST
);
_______________________________________________
devel mailing list
devel@rtems.org
http://lists.rtems.org/mailman/listinfo/devel
