forked from Imagelibrary/rtems
362cf319d4
Replaces the legacy termios API with new termios API (#3034) Replaces the custom PL011 serial driver with RTEMS arm-pl011. Update #3034
151 lines
2.7 KiB
C
151 lines
2.7 KiB
C
/**
|
|
* @file
|
|
*
|
|
* @ingroup raspberrypi_usart
|
|
*
|
|
* @brief Console Configuration.
|
|
*/
|
|
|
|
/*
|
|
* Copyright (c) 2015 Yang Qiao
|
|
* based on work by:
|
|
* Copyright (c) 2013 Alan Cudmore
|
|
*
|
|
* The license and distribution terms for this file may be
|
|
* found in the file LICENSE in this distribution or at
|
|
*
|
|
* http://www.rtems.org/license/LICENSE
|
|
*
|
|
*/
|
|
|
|
#include <rtems/bspIo.h>
|
|
#include <rtems/console.h>
|
|
#include <rtems/sysinit.h>
|
|
|
|
#include <libchip/serial.h>
|
|
#include <libfdt.h>
|
|
|
|
#include <bspopts.h>
|
|
#include <bsp/usart.h>
|
|
#include <bsp/raspberrypi.h>
|
|
#include <bsp/fbcons.h>
|
|
#include <bsp.h>
|
|
#include <bsp/arm-pl011.h>
|
|
#include <bsp/console-termios.h>
|
|
#include <bsp/fdt.h>
|
|
#include <bsp/fatal.h>
|
|
|
|
|
|
#define UART0 "/dev/ttyS0"
|
|
#define FBCONS "/dev/fbcons"
|
|
|
|
arm_pl011_context pl011_context;
|
|
|
|
rpi_fb_context fb_context;
|
|
|
|
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 init_ctx_arm_pl011(
|
|
const void *fdt,
|
|
int node
|
|
)
|
|
{
|
|
arm_pl011_context *ctx = &pl011_context;
|
|
rtems_termios_device_context_initialize(&ctx->base, "UART");
|
|
ctx->regs = raspberrypi_get_reg_of_node(fdt, node);
|
|
}
|
|
|
|
static void register_fb( void )
|
|
{
|
|
if (fbcons_probe(&fb_context.base) == true) {
|
|
rtems_termios_device_install(
|
|
FBCONS,
|
|
&fbcons_fns,
|
|
NULL,
|
|
&fb_context.base);
|
|
}
|
|
}
|
|
|
|
static void console_select( void )
|
|
{
|
|
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 ) {
|
|
BSP_output_char = output_char_fb;
|
|
link(FBCONS, CONSOLE_DEVICE_NAME);
|
|
return ;
|
|
}
|
|
}
|
|
}
|
|
BSP_output_char = output_char_serial;
|
|
link(UART0, CONSOLE_DEVICE_NAME);
|
|
}
|
|
|
|
static void uart_probe(void)
|
|
{
|
|
static bool initialized = false;
|
|
const void *fdt;
|
|
int node;
|
|
|
|
if ( initialized ) {
|
|
return ;
|
|
}
|
|
|
|
fdt = bsp_fdt_get();
|
|
node = fdt_node_offset_by_compatible(fdt, -1, "brcm,bcm2835-pl011");
|
|
|
|
init_ctx_arm_pl011(fdt, node);
|
|
|
|
initialized = true;
|
|
}
|
|
|
|
static void output_char(char c)
|
|
{
|
|
uart_probe();
|
|
output_char_serial(c);
|
|
}
|
|
|
|
rtems_status_code console_initialize(
|
|
rtems_device_major_number major,
|
|
rtems_device_minor_number minor,
|
|
void *arg
|
|
)
|
|
{
|
|
rtems_termios_initialize();
|
|
|
|
uart_probe();
|
|
rtems_termios_device_install(
|
|
UART0,
|
|
&arm_pl011_fns,
|
|
NULL,
|
|
&pl011_context.base
|
|
);
|
|
|
|
register_fb();
|
|
|
|
console_select();
|
|
|
|
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
|
|
); |