[PATCH v2] bsp/raspberrypi: Updated the console API.
Christian Mauderer
list at c-mauderer.de
Tue Jan 7 18:46:21 UTC 2020
On 07/01/2020 18:45, Niteesh wrote:
> You said that the FB was not working, was it because of this bug?
> or else I want to take a look at it.
No, that is a different problem. So if you want feel free to take a look.
The first thing I noted is that the command line is not parsed
correctly. The current console select code searches for a "--console="
but there is only a "console=" in the commandline.txt. You took that
logic over 1:1 from the old console.
>
> On Tue, Jan 7, 2020 at 11:03 PM Niteesh <gsnb.gn at gmail.com
> <mailto:gsnb.gn at gmail.com>> wrote:
>
> Great, thank you it wouldn't have been possible without your help
> and support.
> And thanks for patiently answering my questions :)
Thanks for beeing patient enough to rework the patch again and again.
>
> On Tue, Jan 7, 2020 at 10:58 PM Christian Mauderer
> <list at c-mauderer.de <mailto:list at c-mauderer.de>> wrote:
>
> Pushed with a minor modification: Due to the header reorder it was
> necessary to include one extra header in bsp/fbcons.h. But that
> has been
> a hidden bug anyway.
>
> On 04/01/2020 20:50, G S Niteesh wrote:
> > Replaces the legacy termios API with new termios API (#3034)
> > Replaces the custom PL011 serial driver with RTEMS arm-pl011.
> > Update #3034
> > ---
> > bsps/arm/raspberrypi/console/console-config.c | 143
> +++++++++++----
> > bsps/arm/raspberrypi/console/console_select.c | 114 ------------
> > bsps/arm/raspberrypi/console/fbcons.c | 78 ++++----
> > bsps/arm/raspberrypi/console/usart.c | 167
> ------------------
> > bsps/arm/raspberrypi/include/bsp.h | 2 +
> > bsps/arm/raspberrypi/include/bsp/fbcons.h | 17 +-
> > .../arm/raspberrypi/include/bsp/raspberrypi.h | 54 ++----
> > bsps/arm/raspberrypi/include/bsp/usart.h | 5 +-
> > bsps/arm/raspberrypi/start/bspstart.c | 15 ++
> > c/src/lib/libbsp/arm/raspberrypi/Makefile.am | 6 +-
> > 10 files changed, 197 insertions(+), 404 deletions(-)
> > delete mode 100644 bsps/arm/raspberrypi/console/console_select.c
> > delete mode 100644 bsps/arm/raspberrypi/console/usart.c
> >
> > diff --git a/bsps/arm/raspberrypi/console/console-config.c
> b/bsps/arm/raspberrypi/console/console-config.c
> > index d2186c918b..48c4c6a3ec 100644
> > --- a/bsps/arm/raspberrypi/console/console-config.c
> > +++ b/bsps/arm/raspberrypi/console/console-config.c
> > @@ -19,50 +19,133 @@
> > */
> >
> > #include <rtems/bspIo.h>
> > +#include <rtems/console.h>
> > +#include <rtems/sysinit.h>
> >
> > #include <libchip/serial.h>
> > +#include <libfdt.h>
> >
> > #include <bspopts.h>
> > -#include <bsp/irq.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>
> >
> > -console_tbl Console_Configuration_Ports [] = {
> > - {
> > - .sDeviceName = "/dev/ttyS0",
> > - .deviceType = SERIAL_CUSTOM,
> > - .pDeviceFns = &bcm2835_usart_fns,
> > - .deviceProbe = NULL,
> > - .pDeviceFlow = NULL,
> > - .ulCtrlPort1 = BCM2835_UART0_BASE,
> > - .ulCtrlPort2 = 0,
> > - .ulClock = USART0_DEFAULT_BAUD,
> > - .ulIntVector = BCM2835_IRQ_ID_UART
> > - },
> > - {
> > - .sDeviceName ="/dev/fbcons",
> > - .deviceType = SERIAL_CUSTOM,
> > - .pDeviceFns = &fbcons_fns,
> > - .deviceProbe = fbcons_probe,
> > - .pDeviceFlow = NULL,
> > - },
> > -};
> > -
> > -#define PORT_COUNT \
> > - (sizeof(Console_Configuration_Ports) \
> > - / sizeof(Console_Configuration_Ports [0]))
> > -
> > -unsigned long Console_Configuration_Count = PORT_COUNT;
> > +
> > +#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)
> > {
> > - const console_fns *con =
> > - Console_Configuration_Ports [Console_Port_Minor].pDeviceFns;
> > + 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();
> >
> > - con->deviceWritePolled((int) Console_Port_Minor, c);
> > + 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
> > +);
> > \ No newline at end of file
> > diff --git a/bsps/arm/raspberrypi/console/console_select.c
> b/bsps/arm/raspberrypi/console/console_select.c
> > deleted file mode 100644
> > index bd246ca868..0000000000
> > --- a/bsps/arm/raspberrypi/console/console_select.c
> > +++ /dev/null
> > @@ -1,114 +0,0 @@
> > -/**
> > - * @file
> > - *
> > - * @ingroup raspberrypi_console
> > - *
> > - * @brief console select
> > - */
> > -
> > -/*
> > - * Copyright (c) 2015 Yang Qiao
> > - *
> > - * 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 <bsp.h>
> > -#include <bsp/fatal.h>
> > -#include <rtems/libio.h>
> > -#include <stdlib.h>
> > -#include <string.h>
> > -#include <assert.h>
> > -#include <termios.h>
> > -
> > -#include <rtems/termiostypes.h>
> > -#include <libchip/serial.h>
> > -#include "../../shared/dev/serial/legacy-console.h"
> > -#include <bsp/rpi-fb.h>
> > -
> > -rtems_device_minor_number BSPPrintkPort = 0;
> > -
> > -/*
> > - * Method to return true if the device associated with the
> > - * minor number probs available.
> > - */
> > -static bool bsp_Is_Available( rtems_device_minor_number minor )
> > -{
> > - console_tbl *cptr = Console_Port_Tbl[ minor ];
> > -
> > - /*
> > - * First perform the configuration dependent probe, then the
> > - * device dependent probe
> > - */
> > - if ( ( !cptr->deviceProbe || cptr->deviceProbe( minor ) ) &&
> > - cptr->pDeviceFns->deviceProbe( minor ) ) {
> > - return true;
> > - }
> > -
> > - return false;
> > -}
> > -
> > -/*
> > - * Method to return the first available device.
> > - */
> > -static rtems_device_minor_number bsp_First_Available_Device(
> void )
> > -{
> > - rtems_device_minor_number minor;
> > -
> > - for ( minor = 0; minor < Console_Port_Count; minor++ ) {
> > - console_tbl *cptr = Console_Port_Tbl[ minor ];
> > -
> > - /*
> > - * First perform the configuration dependent probe, then the
> > - * device dependent probe
> > - */
> > -
> > - if ( ( !cptr->deviceProbe || cptr->deviceProbe( minor ) ) &&
> > - cptr->pDeviceFns->deviceProbe( minor ) ) {
> > - return minor;
> > - }
> > - }
> > -
> > - /*
> > - * Error No devices were found. We will want to bail here.
> > - */
> > - bsp_fatal( BSP_FATAL_CONSOLE_NO_DEV );
> > -}
> > -
> > -void bsp_console_select( void )
> > -{
> > - /*
> > - * Reset Console_Port_Minor and
> > - * BSPPrintkPort here if desired.
> > - *
> > - * This default version allows the bsp to set these
> > - * values at creation and will not touch them again
> > - * unless the selected port number is not available.
> > - */
> > - const char *opt;
> > -
> > - Console_Port_Minor = BSP_CONSOLE_UART0;
> > - BSPPrintkPort = BSP_CONSOLE_UART0;
> > -
> > - opt = rpi_cmdline_get_arg( "--console=" );
> > -
> > - if ( opt ) {
> > - if ( strncmp( opt, "fbcons", sizeof( "fbcons" ) - 1 ) ==
> 0 ) {
> > - if ( rpi_video_is_initialized() > 0 ) {
> > - Console_Port_Minor = BSP_CONSOLE_FB;
> > - BSPPrintkPort = BSP_CONSOLE_FB;
> > - }
> > - }
> > - }
> > -
> > - /*
> > - * If the device that was selected isn't available then
> > - * let the user know and select the first available device.
> > - */
> > - if ( !bsp_Is_Available( Console_Port_Minor ) ) {
> > - Console_Port_Minor = bsp_First_Available_Device();
> > - }
> > -}
> > diff --git a/bsps/arm/raspberrypi/console/fbcons.c
> b/bsps/arm/raspberrypi/console/fbcons.c
> > index 3669ba458d..0c0a5087ce 100644
> > --- a/bsps/arm/raspberrypi/console/fbcons.c
> > +++ b/bsps/arm/raspberrypi/console/fbcons.c
> > @@ -18,6 +18,7 @@
> >
> > #include <rtems.h>
> > #include <rtems/libio.h>
> > +#include <rtems/termiostypes.h>
> >
> > #include <stdlib.h>
> >
> > @@ -29,15 +30,6 @@
> > #include <bsp/vc.h>
> > #include <bsp/rpi-fb.h>
> >
> > -/*
> > - * fbcons_init
> > - *
> > - * This function initializes the fb console to a quiecsent
> state.
> > - */
> > -static void fbcons_init( int minor )
> > -{
> > -}
> > -
> > /*
> > * fbcons_open
> > *
> > @@ -45,13 +37,14 @@ static void fbcons_init( int minor )
> > *
> > * Default state is 9600 baud, 8 bits, No parity, and 1 stop
> bit.
> > */
> > -static int fbcons_open(
> > - int major,
> > - int minor,
> > - void *arg
> > +static bool fbcons_open(
> > + struct rtems_termios_tty *tty,
> > + rtems_termios_device_context *base,
> > + struct termios *term,
> > + rtems_libio_open_close_args_t *args
> > )
> > {
> > - return RTEMS_SUCCESSFUL;
> > + return true;
> > }
> >
> > /*
> > @@ -59,13 +52,12 @@ static int fbcons_open(
> > *
> > * This function shuts down the requested port.
> > */
> > -static int fbcons_close(
> > - int major,
> > - int minor,
> > - void *arg
> > +static void fbcons_close(
> > + struct rtems_termios_tty *tty,
> > + rtems_termios_device_context *base,
> > + rtems_libio_open_close_args_t *args
> > )
> > {
> > - return ( RTEMS_SUCCESSFUL );
> > }
> >
> > /*
> > @@ -73,8 +65,8 @@ static int fbcons_close(
> > *
> > * This routine polls out the requested character.
> > */
> > -static void fbcons_write_polled(
> > - int minor,
> > +void fbcons_write_polled(
> > + rtems_termios_device_context *base,
> > char c
> > )
> > {
> > @@ -90,8 +82,8 @@ static void fbcons_write_polled(
> > * Console Termios output entry point when using polled output.
> > *
> > */
> > -static ssize_t fbcons_write_support_polled(
> > - int minor,
> > +static void fbcons_write_support_polled(
> > + rtems_termios_device_context *base,
> > const char *buf,
> > size_t len
> > )
> > @@ -102,14 +94,9 @@ static ssize_t fbcons_write_support_polled(
> > * poll each byte in the string out of the port.
> > */
> > while ( nwrite < len ) {
> > - fbcons_write_polled( minor, *buf++ );
> > + fbcons_write_polled( base, *buf++ );
> > nwrite++;
> > }
> > -
> > - /*
> > - * return the number of bytes written.
> > - */
> > - return nwrite;
> > }
> >
> > /*
> > @@ -117,7 +104,9 @@ static ssize_t fbcons_write_support_polled(
> > *
> > * Console Termios polling input entry point.
> > */
> > -static int fbcons_inbyte_nonblocking_polled( int minor )
> > +static int fbcons_inbyte_nonblocking_polled(
> > + rtems_termios_device_context *base
> > +)
> > {
> > // if( rtems_kbpoll() ) {
> > // int c = getch();
> > @@ -133,15 +122,17 @@ static int
> fbcons_inbyte_nonblocking_polled( int minor )
> > * This function sets the UART channel to reflect the
> requested termios
> > * port settings.
> > */
> > -static int fbcons_set_attributes(
> > - int minor,
> > +static bool fbcons_set_attributes(
> > + rtems_termios_device_context *base,
> > const struct termios *t
> > )
> > {
> > - return 0;
> > + return true;
> > }
> >
> > -bool fbcons_probe( int minor )
> > +bool fbcons_probe(
> > + rtems_termios_device_context *context
> > +)
> > {
> > // rtems_status_code status;
> > static bool firstTime = true;
> > @@ -163,15 +154,12 @@ bool fbcons_probe( int minor )
> > return ret;
> > }
> >
> > -const console_fns fbcons_fns =
> > +const rtems_termios_device_handler fbcons_fns =
> > {
> > - .deviceProbe = libchip_serial_default_probe, /*
> deviceProbe */
> > - .deviceFirstOpen = fbcons_open, /*
> deviceFirstOpen */
> > - .deviceLastClose = fbcons_close, /*
> deviceLastClose */
> > - .deviceRead = fbcons_inbyte_nonblocking_polled, /*
> deviceRead */
> > - .deviceWrite = fbcons_write_support_polled, /*
> deviceWrite */
> > - .deviceInitialize = fbcons_init, /*
> deviceInitialize */
> > - .deviceWritePolled = fbcons_write_polled, /*
> deviceWritePolled */
> > - .deviceSetAttributes = fbcons_set_attributes, /*
> deviceSetAttributes */
> > - .deviceOutputUsesInterrupts = FALSE, /*
> deviceOutputUsesInterrupts*/
> > -};
> > + .first_open = fbcons_open,
> > + .last_close = fbcons_close,
> > + .poll_read = fbcons_inbyte_nonblocking_polled,
> > + .write = fbcons_write_support_polled,
> > + .set_attributes = fbcons_set_attributes,
> > + .mode = TERMIOS_POLLED
> > +};
> > \ No newline at end of file
> > diff --git a/bsps/arm/raspberrypi/console/usart.c
> b/bsps/arm/raspberrypi/console/usart.c
> > deleted file mode 100644
> > index 25fb523621..0000000000
> > --- a/bsps/arm/raspberrypi/console/usart.c
> > +++ /dev/null
> > @@ -1,167 +0,0 @@
> > -/**
> > - * @file
> > - *
> > - * @ingroup raspberrypi_usart
> > - *
> > - * @brief USART support.
> > - */
> > -
> > -/*
> > - * 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 <libchip/sersupp.h>
> > -
> > -#include <bsp.h>
> > -#include <bsp/irq.h>
> > -#include <bsp/usart.h>
> > -#include <bsp/raspberrypi.h>
> > -#include <rtems/bspIo.h>
> > -
> > -static void usart_delay(uint32_t n)
> > -{
> > - volatile uint32_t i = 0;
> > -
> > - for(i = 0; i < n; i++)
> > - ;
> > -}
> > -
> > -#if 0
> > -/*
> > - * These will be useful when the driver supports interrupt
> driven IO.
> > - */
> > -static rtems_vector_number usart_get_irq_number(const
> console_tbl *ct)
> > -{
> > - return ct->ulIntVector;
> > -}
> > -
> > -static uint32_t usart_get_baud(const console_tbl *ct)
> > -{
> > - return ct->ulClock;
> > -}
> > -#endif
> > -
> > -static void usart_set_baud(int minor, int baud)
> > -{
> > - /*
> > - * Nothing for now
> > - */
> > - return;
> > -}
> > -
> > -static void usart_initialize(int minor)
> > -{
> > - unsigned int gpio_reg;
> > -
> > - /*
> > - ** Program GPIO pins for UART 0
> > - */
> > - gpio_reg = BCM2835_REG(BCM2835_GPIO_GPFSEL1);
> > - gpio_reg &= ~(7<<12); /* gpio14 */
> > - gpio_reg |= (4<<12); /* alt0 */
> > - gpio_reg &= ~(7<<15); /* gpio15 */
> > - gpio_reg |= (4<<15); /* alt0 */
> > - BCM2835_REG(BCM2835_GPIO_GPFSEL1) = gpio_reg;
> > -
> > - BCM2835_REG(BCM2835_GPIO_GPPUD) = 0;
> > - usart_delay(150);
> > - BCM2835_REG(BCM2835_GPIO_GPPUDCLK0) = (1<<14)|(1<<15);
> > - usart_delay(150);
> > - BCM2835_REG(BCM2835_GPIO_GPPUDCLK0) = 0;
> > -
> > - /*
> > - ** Init the PL011 UART
> > - */
> > - BCM2835_REG(BCM2835_UART0_CR) = 0;
> > - BCM2835_REG(BCM2835_UART0_ICR) = 0x7FF;
> > - BCM2835_REG(BCM2835_UART0_IMSC) = 0;
> > - BCM2835_REG(BCM2835_UART0_IBRD) = 1;
> > - BCM2835_REG(BCM2835_UART0_FBRD) = 40;
> > - BCM2835_REG(BCM2835_UART0_LCRH) = 0x70;
> > - BCM2835_REG(BCM2835_UART0_RSRECR) = 0;
> > -
> > - BCM2835_REG(BCM2835_UART0_CR) = 0x301;
> > -
> > - BCM2835_REG(BCM2835_UART0_IMSC) = BCM2835_UART0_IMSC_RX;
> > -
> > - usart_set_baud(minor, 115000);
> > -}
> > -
> > -static int usart_first_open(int major, int minor, void *arg)
> > -{
> > - rtems_libio_open_close_args_t *oc =
> (rtems_libio_open_close_args_t *) arg;
> > - struct rtems_termios_tty *tty = (struct rtems_termios_tty
> *) oc->iop->data1;
> > - const console_tbl *ct = Console_Port_Tbl [minor];
> > - console_data *cd = &Console_Port_Data [minor];
> > -
> > - cd->termios_data = tty;
> > - rtems_termios_set_initial_baud(tty, ct->ulClock);
> > -
> > - return 0;
> > -}
> > -
> > -static int usart_last_close(int major, int minor, void *arg)
> > -{
> > - return 0;
> > -}
> > -
> > -static int usart_read_polled(int minor)
> > -{
> > - if (minor == 0) {
> > - if (((BCM2835_REG(BCM2835_UART0_FR)) &
> BCM2835_UART0_FR_RXFE) == 0) {
> > - return((BCM2835_REG(BCM2835_UART0_DR)) & 0xFF );
> > - } else {
> > - return -1;
> > - }
> > - } else {
> > - printk("Unknown console minor number: %d\n", minor);
> > - return -1;
> > - }
> > -}
> > -
> > -static void usart_write_polled(int minor, char c)
> > -{
> > - while (1) {
> > - if ((BCM2835_REG(BCM2835_UART0_FR) &
> BCM2835_UART0_FR_TXFF) == 0)
> > - break;
> > - }
> > - BCM2835_REG(BCM2835_UART0_DR) = c;
> > -}
> > -
> > -static ssize_t usart_write_support_polled(
> > - int minor,
> > - const char *s,
> > - size_t n
> > -)
> > -{
> > - ssize_t i = 0;
> > -
> > - for (i = 0; i < n; ++i) {
> > - usart_write_polled(minor, s [i]);
> > - }
> > -
> > - return n;
> > -}
> > -
> > -static int usart_set_attributes(int minor, const struct
> termios *term)
> > -{
> > - return -1;
> > -}
> > -
> > -const console_fns bcm2835_usart_fns = {
> > - .deviceProbe = libchip_serial_default_probe,
> > - .deviceFirstOpen = usart_first_open,
> > - .deviceLastClose = usart_last_close,
> > - .deviceRead = usart_read_polled,
> > - .deviceWrite = usart_write_support_polled,
> > - .deviceInitialize = usart_initialize,
> > - .deviceWritePolled = usart_write_polled,
> > - .deviceSetAttributes = usart_set_attributes,
> > - .deviceOutputUsesInterrupts = false
> > -};
> > diff --git a/bsps/arm/raspberrypi/include/bsp.h
> b/bsps/arm/raspberrypi/include/bsp.h
> > index b81d19cd76..190dd16184 100644
> > --- a/bsps/arm/raspberrypi/include/bsp.h
> > +++ b/bsps/arm/raspberrypi/include/bsp.h
> > @@ -54,6 +54,8 @@ extern "C" {
> > #define BSP_CONSOLE_UART0 0
> > #define BSP_CONSOLE_FB 1
> >
> > +void *raspberrypi_get_reg_of_node(const void *fdt, int node);
> > +
> > void rpi_init_cmdline(void);
> > const char *rpi_cmdline_get_cached(void);
> > const char *rpi_cmdline_get_raw(void);
> > diff --git a/bsps/arm/raspberrypi/include/bsp/fbcons.h
> b/bsps/arm/raspberrypi/include/bsp/fbcons.h
> > index d0e126699a..9de75ee5a4 100644
> > --- a/bsps/arm/raspberrypi/include/bsp/fbcons.h
> > +++ b/bsps/arm/raspberrypi/include/bsp/fbcons.h
> > @@ -33,12 +33,25 @@ extern "C" {
> >
> > #define FB_CONSOLE 0x50492835
> >
> > -bool fbcons_probe( int minor );
> > +bool fbcons_probe(
> > + rtems_termios_device_context *base
> > + );
> > +
> > +void fbcons_write_polled(
> > + rtems_termios_device_context *base,
> > + char c
> > +);
> > +
> > +void output_char_fb(char c);
> > +
> > +typedef struct {
> > + rtems_termios_device_context base;
> > +} rpi_fb_context ;
> >
> > /*
> > * Driver function table
> > */
> > -extern const console_fns fbcons_fns;
> > +extern const rtems_termios_device_handler fbcons_fns;
> >
> > #ifdef __cplusplus
> > }
> > diff --git a/bsps/arm/raspberrypi/include/bsp/raspberrypi.h
> b/bsps/arm/raspberrypi/include/bsp/raspberrypi.h
> > index 40c80cf408..eeb48c42f1 100644
> > --- a/bsps/arm/raspberrypi/include/bsp/raspberrypi.h
> > +++ b/bsps/arm/raspberrypi/include/bsp/raspberrypi.h
> > @@ -53,12 +53,24 @@
> > */
> >
> > #if (BSP_IS_RPI2 == 1)
> > - #define RPI_PERIPHERAL_BASE 0x3F000000
> > + #define RPI_PERIPHERAL_BASE 0x3F000000
> > + #define BASE_OFFSET 0X3F000000
> > #else
> > - #define RPI_PERIPHERAL_BASE 0x20000000
> > + #define RPI_PERIPHERAL_BASE 0x20000000
> > + #define BASE_OFFSET 0X5E000000
> > #endif
> >
> > -#define RPI_PERIPHERAL_SIZE 0x01000000
> > +#define RPI_PERIPHERAL_SIZE 0x01000000
> > +
> > +/**
> > + * @name Bus to Physical address translation
> > + * Macro.
> > + * @{
> > + */
> > +
> > +#define BUS_TO_PHY(x) ((x) - BASE_OFFSET)
> > +
> > +/** @} */
> >
> > /**
> > * @name Internal ARM Timer Registers
> > @@ -184,42 +196,6 @@
> >
> > /** @} */
> >
> > -/**
> > - * @name UART 0 (PL011) Registers
> > - *
> > - * @{
> > - */
> > -
> > -#define BCM2835_UART0_BASE (RPI_PERIPHERAL_BASE + 0x201000)
> > -
> > -#define BCM2835_UART0_DR (BCM2835_UART0_BASE + 0x00)
> > -#define BCM2835_UART0_RSRECR (BCM2835_UART0_BASE + 0x04)
> > -#define BCM2835_UART0_FR (BCM2835_UART0_BASE + 0x18)
> > -#define BCM2835_UART0_ILPR (BCM2835_UART0_BASE + 0x20)
> > -#define BCM2835_UART0_IBRD (BCM2835_UART0_BASE + 0x24)
> > -#define BCM2835_UART0_FBRD (BCM2835_UART0_BASE + 0x28)
> > -#define BCM2835_UART0_LCRH (BCM2835_UART0_BASE + 0x2C)
> > -#define BCM2835_UART0_CR (BCM2835_UART0_BASE + 0x30)
> > -#define BCM2835_UART0_IFLS (BCM2835_UART0_BASE + 0x34)
> > -#define BCM2835_UART0_IMSC (BCM2835_UART0_BASE + 0x38)
> > -#define BCM2835_UART0_RIS (BCM2835_UART0_BASE + 0x3C)
> > -#define BCM2835_UART0_MIS (BCM2835_UART0_BASE + 0x40)
> > -#define BCM2835_UART0_ICR (BCM2835_UART0_BASE + 0x44)
> > -#define BCM2835_UART0_DMACR (BCM2835_UART0_BASE + 0x48)
> > -#define BCM2835_UART0_ITCR (BCM2835_UART0_BASE + 0x80)
> > -#define BCM2835_UART0_ITIP (BCM2835_UART0_BASE + 0x84)
> > -#define BCM2835_UART0_ITOP (BCM2835_UART0_BASE + 0x88)
> > -#define BCM2835_UART0_TDR (BCM2835_UART0_BASE + 0x8C)
> > -
> > -#define BCM2835_UART0_MIS_RX 0x10
> > -#define BCM2835_UART0_MIS_TX 0x20
> > -#define BCM2835_UART0_IMSC_RX 0x10
> > -#define BCM2835_UART0_IMSC_TX 0x20
> > -#define BCM2835_UART0_FR_RXFE 0x10
> > -#define BCM2835_UART0_FR_TXFF 0x20
> > -#define BCM2835_UART0_ICR_RX 0x10
> > -#define BCM2835_UART0_ICR_TX 0x20
> > -
> > /** @} */
> >
> > /**
> > diff --git a/bsps/arm/raspberrypi/include/bsp/usart.h
> b/bsps/arm/raspberrypi/include/bsp/usart.h
> > index d3e710c5e9..abbf53626c 100644
> > --- a/bsps/arm/raspberrypi/include/bsp/usart.h
> > +++ b/bsps/arm/raspberrypi/include/bsp/usart.h
> > @@ -32,9 +32,8 @@
> > extern "C" {
> > #endif /* __cplusplus */
> >
> > -#define USART0_DEFAULT_BAUD 115000
> > -
> > -extern const console_fns bcm2835_usart_fns;
> > +#define PL011_DEFAULT_BAUD 115000
> > +#define BCM2835_PL011_BASE (RPI_PERIPHERAL_BASE + 0x201000)
> >
> > #ifdef __cplusplus
> > }
> > diff --git a/bsps/arm/raspberrypi/start/bspstart.c
> b/bsps/arm/raspberrypi/start/bspstart.c
> > index 6ff286f840..49896e4d47 100644
> > --- a/bsps/arm/raspberrypi/start/bspstart.c
> > +++ b/bsps/arm/raspberrypi/start/bspstart.c
> > @@ -24,6 +24,8 @@
> > #include <bsp/raspberrypi.h>
> > #include <bsp/vc.h>
> >
> > +#include <libfdt.h>
> > +
> > static const struct {
> > uint32_t code;
> > const char* label;
> > @@ -86,6 +88,19 @@ static const char* rpi_mem[] =
> >
> > #define NUMOF(_s) (sizeof(_s) / sizeof(_s[0]))
> >
> > +void *raspberrypi_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 (BUS_TO_PHY((void *) fdt32_to_cpu(val[0])));
> > +}
> > +
> > void bsp_start(void)
> > {
> > bcm2835_get_board_spec_entries spec = { 0 };
> > diff --git a/c/src/lib/libbsp/arm/raspberrypi/Makefile.am
> b/c/src/lib/libbsp/arm/raspberrypi/Makefile.am
> > index 77aa360977..57562c10c7 100644
> > --- a/c/src/lib/libbsp/arm/raspberrypi/Makefile.am
> > +++ b/c/src/lib/libbsp/arm/raspberrypi/Makefile.am
> > @@ -64,11 +64,9 @@ librtemsbsp_a_SOURCES +=
> ../../../../../../bsps/arm/shared/cp15/arm-cp15-set-exc
> > librtemsbsp_a_SOURCES +=
> ../../../../../../bsps/arm/raspberrypi/irq/irq.c
> >
> > # Console
> > -librtemsbsp_a_SOURCES +=
> ../../../../../../bsps/shared/dev/serial/legacy-console.c
> > -librtemsbsp_a_SOURCES +=
> ../../../../../../bsps/shared/dev/serial/legacy-console-control.c
> > +librtemsbsp_a_SOURCES +=
> ../../../../../../bsps/shared/dev/serial/console-termios.c
> > +librtemsbsp_a_SOURCES +=
> ../../../../../../bsps/arm/shared/serial/arm-pl011.c
> > librtemsbsp_a_SOURCES +=
> ../../../../../../bsps/arm/raspberrypi/console/console-config.c
> > -librtemsbsp_a_SOURCES +=
> ../../../../../../bsps/arm/raspberrypi/console/console_select.c
> > -librtemsbsp_a_SOURCES +=
> ../../../../../../bsps/arm/raspberrypi/console/usart.c
> > librtemsbsp_a_SOURCES +=
> ../../../../../../bsps/arm/raspberrypi/console/fb.c
> > librtemsbsp_a_SOURCES +=
> ../../../../../../bsps/arm/raspberrypi/console/fbcons.c
> > librtemsbsp_a_SOURCES +=
> ../../../../../../bsps/arm/raspberrypi/console/outch.c
> >
>
More information about the devel
mailing list