[PATCH v3] Raspberrypi: updated the console interface.

[Niteesh]

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
);
-------------- next part --------------
An HTML attachment was scrubbed...
URL: <http://lists.rtems.org/pipermail/devel/attachments/20191230/7791336f/attachment.html>