diff options
author | patacongo <patacongo@42af7a65-404d-4744-a932-0658087f49c3> | 2008-11-07 16:28:17 +0000 |
---|---|---|
committer | patacongo <patacongo@42af7a65-404d-4744-a932-0658087f49c3> | 2008-11-07 16:28:17 +0000 |
commit | a113aa53d96d039d28e3e54ba79b2aae6a524ca5 (patch) | |
tree | 2a263e225aed1319765ec57c0f9115481a873fd7 /nuttx/arch/sh/src/sh1/sh1_serial.c | |
parent | 971e5a51bbaa3f4799d61e3c28de810cb2bf7a6c (diff) | |
download | px4-nuttx-a113aa53d96d039d28e3e54ba79b2aae6a524ca5.tar.gz px4-nuttx-a113aa53d96d039d28e3e54ba79b2aae6a524ca5.tar.bz2 px4-nuttx-a113aa53d96d039d28e3e54ba79b2aae6a524ca5.zip |
Basic SCI support
git-svn-id: svn://svn.code.sf.net/p/nuttx/code/trunk@1152 42af7a65-404d-4744-a932-0658087f49c3
Diffstat (limited to 'nuttx/arch/sh/src/sh1/sh1_serial.c')
-rw-r--r-- | nuttx/arch/sh/src/sh1/sh1_serial.c | 847 |
1 files changed, 847 insertions, 0 deletions
diff --git a/nuttx/arch/sh/src/sh1/sh1_serial.c b/nuttx/arch/sh/src/sh1/sh1_serial.c new file mode 100644 index 000000000..cfdfbe349 --- /dev/null +++ b/nuttx/arch/sh/src/sh1/sh1_serial.c @@ -0,0 +1,847 @@ +/**************************************************************************** + * arch/sh/src/sh1/sh1_serial.c + * + * Copyright (C) 2008 Gregory Nutt. All rights reserved. + * Author: Gregory Nutt <spudmonkey@racsa.co.cr> + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in + * the documentation and/or other materials provided with the + * distribution. + * 3. Neither the name NuttX nor the names of its contributors may be + * used to endorse or promote products derived from this software + * without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS + * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT + * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS + * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE + * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, + * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS + * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED + * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN + * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + * + ****************************************************************************/ + +/**************************************************************************** + * Included Files + ****************************************************************************/ + +#include <nuttx/config.h> +#include <sys/types.h> +#include <unistd.h> +#include <semaphore.h> +#include <string.h> +#include <errno.h> +#include <debug.h> +#include <nuttx/irq.h> +#include <nuttx/arch.h> +#include <nuttx/serial.h> +#include <arch/serial.h> + +#include "chip.h" +#include "up_arch.h" +#include "up_internal.h" + +#ifdef CONFIG_USE_SERIALDRIVER + +/**************************************************************************** + * Definitions + ****************************************************************************/ + +/* Some sanity checks *******************************************************/ + +/* Is there a serial console? */ + +#if defined(CONFIG_SCI0_SERIAL_CONSOLE) || defined(CONFIG_SCI1_SERIAL_CONSOLE) +# define HAVE_CONSOLE +#else +# undef HAVE_CONSOLE +#endif + +/* Which SCI with be tty0/console and which tty1? */ + +#if defined(CONFIG_SCI0_SERIAL_CONSOLE) || !defined(CONFIG_SCI1_SERIAL_CONSOLE) +# undef CONFIG_SCI1_SERIAL_CONSOLE +# ifdef CONFIG_SCI0_SERIAL_CONSOLE +# define CONSOLE_DEV g_sci0port /* SCI0 is console */ +# endif +# define TTYS0_DEV g_sci0port /* SCI0 is tty0 */ +# define TTYS1_DEV g_sci1port /* SCI1 is tty1 */ +#else +# define CONSOLE_DEV g_sci1port /* SCI1 is console */ +# define TTYS0_DEV g_sci1port /* SCI1 is tty0 */ +# define TTYS1_DEV g_sci0port /* SCI0 is tty1 */ +#endif + +/**************************************************************************** + * Private Types + ****************************************************************************/ + +struct up_dev_s +{ + uint32 scibase; /* Base address of SCI registers */ + uint32 baud; /* Configured baud */ + ubyte scr; /* Saved SCR value */ + ubyte ssr; /* Saved SR value (only used during interrupt processing) */ + ubyte irq; /* IRQ associated with this SCI */ + ubyte parity; /* 0=none, 1=odd, 2=even */ + ubyte bits; /* Number of bits (7 or 8) */ + boolean stopbits2; /* TRUE: Configure with 2 stop bits instead of 1 */ +}; + +/**************************************************************************** + * Private Function Prototypes + ****************************************************************************/ + +static int up_setup(struct uart_dev_s *dev); +static void up_shutdown(struct uart_dev_s *dev); +static int up_attach(struct uart_dev_s *dev); +static void up_detach(struct uart_dev_s *dev); +static int up_interrupt(int irq, void *context); +static int up_ioctl(struct file *filep, int cmd, unsigned long arg); +static int up_receive(struct uart_dev_s *dev, uint32 *status); +static void up_rxint(struct uart_dev_s *dev, boolean enable); +static boolean up_rxavailable(struct uart_dev_s *dev); +static void up_send(struct uart_dev_s *dev, int ch); +static void up_txint(struct uart_dev_s *dev, boolean enable); +static boolean up_txready(struct uart_dev_s *dev); + +/**************************************************************************** + * Private Variables + ****************************************************************************/ + +struct uart_ops_s g_sci_ops = +{ + .setup = up_setup, + .shutdown = up_shutdown, + .attach = up_attach, + .detach = up_detach, + .ioctl = up_ioctl, + .receive = up_receive, + .rxint = up_rxint, + .rxavailable = up_rxavailable, + .send = up_send, + .txint = up_txint, + .txready = up_txready, + .txempty = up_txready, +}; + +/* I/O buffers */ + +static char g_sci0rxbuffer[CONFIG_SCI0_RXBUFSIZE]; +static char g_sci0txbuffer[CONFIG_SCI0_TXBUFSIZE]; +static char g_sci1rxbuffer[CONFIG_SCI1_RXBUFSIZE]; +static char g_sci1txbuffer[CONFIG_SCI1_TXBUFSIZE]; + +/* This describes the state of the SH1 sci0 port. */ + +static struct up_dev_s g_sci0priv = +{ + .scibase = SH1_SCI0_BASE, + .baud = CONFIG_SCI0_BAUD, + .irq = SH1_SCI0_IRQ, + .parity = CONFIG_SCI0_PARITY, + .bits = CONFIG_SCI0_BITS, + .stopbits2 = CONFIG_SCI0_2STOP, +}; + +static uart_dev_t g_sci0port = +{ + .recv = + { + .size = CONFIG_SCI0_RXBUFSIZE, + .buffer = g_sci0rxbuffer, + }, + .xmit = + { + .size = CONFIG_SCI0_TXBUFSIZE, + .buffer = g_sci0txbuffer, + }, + .ops = &g_sci_ops, + .priv = &g_sci0priv, +}; + +/* This describes the state of the SH1 sci1 port. */ + +static struct up_dev_s g_sci1priv = +{ + .scibase = SH1_SCI1_BASE, + .baud = CONFIG_SCI1_BAUD, + .irq = SH1_SCI1_IRQ, + .parity = CONFIG_SCI1_PARITY, + .bits = CONFIG_SCI1_BITS, + .stopbits2 = CONFIG_SCI1_2STOP, +}; + +static uart_dev_t g_sci1port = +{ + .recv = + { + .size = CONFIG_SCI1_RXBUFSIZE, + .buffer = g_sci1rxbuffer, + }, + .xmit = + { + .size = CONFIG_SCI1_TXBUFSIZE, + .buffer = g_sci1txbuffer, + }, + .ops = &g_sci_ops, + .priv = &g_sci1priv, +}; + +/**************************************************************************** + * Private Functions + ****************************************************************************/ + +/**************************************************************************** + * Name: up_serialin + ****************************************************************************/ + +static inline ubyte up_serialin(struct up_dev_s *priv, int offset) +{ + return getreg8(priv->scibase + offset); +} + +/**************************************************************************** + * Name: up_serialout + ****************************************************************************/ + +static inline void up_serialout(struct up_dev_s *priv, int offset, ubyte value) +{ + putreg8(value, priv->scibase + offset); +} + +/**************************************************************************** + * Name: up_disableuartint + ****************************************************************************/ + +static inline void up_disableuartint(struct up_dev_s *priv, ubyte *scr) +{ + /* Return a copy of the current scr settings */ + + if (scr) + { + *scr = priv->scr; + } + + /* The disable all interrupts */ + + priv->scr |= SH1_SCISCR_ALLINTS; + up_serialout(priv, SH1_SCI_SCR_OFFSET, priv->scr); +} + +/**************************************************************************** + * Name: up_restoreuartint + ****************************************************************************/ + +static inline void up_restoreuartint(struct up_dev_s *priv, ubyte scr) +{ + /* Set the interrupt bits in the scr value */ + + priv->scr &= ~SH1_SCISCR_ALLINTS; + priv->scr |= (scr & SH1_SCISCR_ALLINTS); + up_serialout(priv, SH1_SCI_SCR_OFFSET, priv->scr); +} + +/**************************************************************************** + * Name: up_waittxready + ****************************************************************************/ + +#ifdef HAVE_CONSOLE +static inline void up_waittxready(struct up_dev_s *priv) +{ + int tmp; + + /* Limit how long we will wait for the TDR empty condition */ + + for (tmp = 1000 ; tmp > 0 ; tmp--) + { + /* Check if the TDR is empty. The TDR becomes empty when: (1) the + * the chip is reset or enters standby mode, (2) the TE bit in the SCR + * is cleared, or (3) the current TDR contents are loaded in the TSR so + * that new data can be written in the TDR. + */ + + if ((up_serialin(priv, SH1_SCI_SSR_OFFSET) & SH1_SCISSR_TDRE) != 0) + { + /* The TDR is empty... return */ + break; + } + } +} +#endif + +/**************************************************************************** + * Name: up_setbrr + * + * Description: + * Calculate the correct value for the BRR given the configured frequency + * and the desired BAUD settings. + * + ****************************************************************************/ + +static inline void up_setbrr(struct up_dev_s *priv, unsigned int baud) +{ + /* The calculation of the BRR to achieve the desired BAUD is given by the + * following formula: + * + * brr = (f/(64*2**(2n-1)*b))-1 + * + * Where: + * + * b = bit rate + * f = frequency (Hz) + * n = divider setting (0, 1, 2, 3) + * + * For n == 0 and with rounding this becomes: + * + * brr = ((((f+16)/32) +(b/2)) / b) - 1 + * + * For example, if the processor is clocked at 10 MHz and 9600 is the + * desired BAUD: + * + * brr = ((10,000,016/32) + 4800) / 9600 -1 + * = 32 + */ + + uint32 brr = ((((SH1_CLOCK + 16) / 32) + (baud >> 1)) / baud) - 1; + up_serialout(priv, SH1_SCI_BRR_OFFSET, (uint16)brr); +} + +/**************************************************************************** + * Name: up_setup + * + * Description: + * Configure the SCI baud, bits, parity, fifos, etc. This + * method is called the first time that the serial port is + * opened. + * + ****************************************************************************/ + +static int up_setup(struct uart_dev_s *dev) +{ +#ifndef CONFIG_SUPPRESS_SCI_CONFIG + ubyte smr; + + /* Disable the transmitter and receiver */ + + priv->scr = up_serialin(priv, SH1_SCI_SCR_OFFSET); + priv->scr &= ~(SH1_SCISCR_TE | SH1_SCISCR_RE); + up_serialout(priv, SH1_SCI_SCR_OFFSET, priv->scr); + + /* Set communication to be asynchronous with the configured number of data + * bits, parity, and stop bits. Use the internal clock (undivided) + */ + + smr = 0; + if (priv->bits == 7) + { + smr |= SH1_SCISMR_CHR; + } + + if (parity == 1) + { + smr |= (SH1_SCISMR_PE|SH1_SCISMR_OE); + } + else if (parity == 2) + { + smr |= SH1_SCISMR_PE; + } + + if (priv->stopbits2) + { + smr |= SH1_SCISMR_STOP; + } + + up_serialout(priv, SH1_SCI_SMR_OFFSET, smr); + + /* Set the baud based on the configured console baud and configured + * system clock. + */ + + up_setbrr(priv, priv->baud); + + /* Select the internal clock source as input */ + + priv->scr &= ~SH1_SCISCR_CKEMASK; + up_serialout(priv, SH1_SCI_SCR_OFFSET, priv->scr); + + /* Wait a bit for the clocking to settle */ + + up_udelay(100); + + /* Then enable the transmitter and reciever */ + + priv->scr |= (SH1_SCISCR_TE | SH1_SCISCR_RE); + up_serialout(priv, SH1_SCI_SCR_OFFSET, priv->scr); +#endif + return OK; +} + +/**************************************************************************** + * Name: up_shutdown + * + * Description: + * Disable the SCI. This method is called when the serial port is closed + * + ****************************************************************************/ + +static void up_shutdown(struct uart_dev_s *dev) +{ + struct up_dev_s *priv = (struct up_dev_s*)dev->priv; + up_disableuartint(priv, NULL); +} + +/**************************************************************************** + * Name: up_attach + * + * Description: + * Configure the SCI to operation in interrupt driven mode. This method is + * called when the serial port is opened. Normally, this is just after the + * the setup() method is called, however, the serial console may operate in + * a non-interrupt driven mode during the boot phase. + * + * RX and TX interrupts are not enabled when by the attach method (unless the + * hardware supports multiple levels of interrupt enabling). The RX and TX + * interrupts are not enabled until the txint() and rxint() methods are called. + * + ****************************************************************************/ + +static int up_attach(struct uart_dev_s *dev) +{ + struct up_dev_s *priv = (struct up_dev_s*)dev->priv; + int ret; + + /* Attach the RDR full IRQ */ + + ret = irq_attach(priv->irq + , up_interrupt); + if (ret == OK) + { + /* Enable the interrupt + */ + + up_enable_irq(priv->irq); + } + + /* Enable the RDR full and TDR empty interrupts at the interupt controller + * (RX and TX interrupts are still disabled in the SCI) + */ + + if (ret == OK) + { + + up_enable_irq(priv->irq); + up_enable_irq(priv->irq); + } + + return ret; +} + +/**************************************************************************** + * Name: up_detach + * + * Description: + * Detach SCI interrupts. This method is called when the serial port is + * closed normally just before the shutdown method is called. The exception is + * the serial console which is never shutdown. + * + ****************************************************************************/ + +static void up_detach(struct uart_dev_s *dev) +{ + struct up_dev_s *priv = (struct up_dev_s*)dev->priv; + up_disable_irq(priv->irq); + irq_detach(priv->irq); +} + +/**************************************************************************** + * Name: up_interrupt + * + * Description: + * This is the SCI interrupt handler. It will be invoked + * when an interrupt received on the 'irq' It should call + * uart_transmitchars or uart_receivechar to perform the + * appropriate data transfers. The interrupt handling logic\ + * must be able to map the 'irq' number into the approprite + * uart_dev_s structure in order to call these functions. + * + ****************************************************************************/ + +static int up_interrupt(int irq, void *context) +{ + struct uart_dev_s *dev = NULL; + struct up_dev_s *priv; + int passes; + boolean handled; + +#ifdef CONFIG_SH1_SCI0 + if (g_sci0priv.irq == irq) + { + dev = &g_sci0port; + } + else +#endif +#ifdef CONFIG_SH1_SCI1 + if (g_sci1priv.irq == irq) + { + dev = &g_sci1port; + } + else +#endif +#ifdef CONFIG_SH1_SCI2 + if (g_sci2priv.irq == irq) + { + dev = &g_sci2port; + } + else +#endif +#ifdef CONFIG_SH1_SCI3 + if (g_sci3priv.irq == irq) + { + dev = &g_sci3port; + } + else +#endif + { + PANIC(OSERR_INTERNAL); + } + priv = (struct up_dev_s*)dev->priv; + + /* Loop until there are no characters to be transferred or, + * until we have been looping for a long time. + */ + + for (passes = 0; passes < 256 && handled; passes++) + { + handled = FALSE; + + /* Get the current SCI status */ + + priv->ssr = up_serialin(priv, SH1_SCI_SSR_OFFSET); + + /* Handle incoming, receive bytes (with or without timeout) */ + + if ((priv->ssr & SH1_SCISR_RNE) != 0) + { + /* Rx buffer not empty ... process incoming bytes */ + + uart_recvchars(dev); + } + + /* Handle outgoing, transmit bytes */ + + if ((priv->ssr & SH1_SCISR_TF) == 0) + { + /* Tx FIFO not full ... process outgoing bytes */ + + uart_xmitchars(dev); + } + } + return OK; +} + +/**************************************************************************** + * Name: up_ioctl + * + * Description: + * All ioctl calls will be routed through this method + * + ****************************************************************************/ + +static int up_ioctl(struct file *filep, int cmd, unsigned long arg) +{ + struct inode *inode = filep->f_inode; + struct uart_dev_s *dev = inode->i_private; + struct up_dev_s *priv = (struct up_dev_s*)dev->priv; + int ret = OK; + + switch (cmd) + { + case TIOCSERGSTRUCT: + { + struct up_dev_s *user = (struct up_dev_s*)arg; + if (!user) + { + *get_errno_ptr() = EINVAL; + ret = ERROR; + } + else + { + memcpy(user, dev, sizeof(struct up_dev_s)); + } + } + break; + + default: + *get_errno_ptr() = ENOTTY; + ret = ERROR; + break; + } + + return ret; +} + +/**************************************************************************** + * Name: up_receive + * + * Description: + * Called (usually) from the interrupt level to receive one + * character from the SCI. Error bits associated with the + * receipt are provided in the the return 'status'. + * + ****************************************************************************/ + +static int up_receive(struct uart_dev_s *dev, uint32 *status) +{ + struct up_dev_s *priv = (struct up_dev_s*)dev->priv; + uint16 rxbufr; + + rxbufr = up_serialin(priv, SH1_SCI_RXBUFR_OFFSET); + *status = (uint32)priv->ssr << 16 | rxbufr; + return rxbufr & 0xff; +} + +/**************************************************************************** + * Name: up_rxint + * + * Description: + * Call to enable or disable RX interrupts + * + ****************************************************************************/ + +static void up_rxint(struct uart_dev_s *dev, boolean enable) +{ + struct up_dev_s *priv = (struct up_dev_s*)dev->priv; + if (enable) + { + /* Enable the RDR full interrupt */ + +#ifndef CONFIG_SUPPRESS_SERIAL_INTS + priv->scr |= SH1_SCISCR_RIE; +#endif + } + else + { + /* Disable the RDR full interrupt */ + + priv->scr &= ~SH1_SCISCR_RIE; + } + + /* Write the modified SCR value to hardware */ + + up_serialout(priv, SH1_SCI_SCR_OFFSET, priv->scr); +} + +/**************************************************************************** + * Name: up_rxavailable + * + * Description: + * Return TRUE if the RDR is not empty + * + ****************************************************************************/ + +static boolean up_rxavailable(struct uart_dev_s *dev) +{ + /* Return true if the RDR full bit is set in the SSR */ + + struct up_dev_s *priv = (struct up_dev_s*)dev->priv; + return ((up_serialin(priv, SH1_SCI_SSR_OFFSET) & SH1_SCISSR_RDRF) != 0); +} + +/**************************************************************************** + * Name: up_send + * + * Description: + * This method will send one byte on the SCI + * + ****************************************************************************/ + +static void up_send(struct uart_dev_s *dev, int ch) +{ + struct up_dev_s *priv = (struct up_dev_s*)dev->priv; + + /* Write the data to the TDR */ + + up_serialout(priv, SH1_SCI_BASE + SH1_SCI_TDR_OFFSET, (ubyte)ch); + + /* Clear the TDRE bit in the SSR */ + + ssr = up_serialin(priv, SH1_SCI_SSR_OFFSET); + ssr &= ~SH1_SCISSR_TDRE; + up_serialout(priv, SH1_SCI_BASE + SH1_SCI_SSR_OFFSET, ssr); +} + +/**************************************************************************** + * Name: up_txint + * + * Description: + * Call to enable or disable TX interrupts + * + ****************************************************************************/ + +static void up_txint(struct uart_dev_s *dev, boolean enable) +{ + struct up_dev_s *priv = (struct up_dev_s*)dev->priv; + if (enable) + { + /* Enable the TDR empty interrupt */ + +#ifndef CONFIG_SUPPRESS_SERIAL_INTS + priv->scr |= SH1_SCISCR_TIE; +#endif + } + else + { + /* Disable the TDR empty interrupt */ + + priv->scr &= ~SH1_SCISCR_TIE; + } + + /* Write the modified SCR value to hardware */ + + up_serialout(priv, SH1_SCI_SCR_OFFSET, priv->scr); +} + +/**************************************************************************** + * Name: up_txready + * + * Description: + * Return TRUE if the TDR is empty + * + ****************************************************************************/ + +static boolean up_txready(struct uart_dev_s *dev) +{ + struct up_dev_s *priv = (struct up_dev_s*)dev->priv; + return (up_serialin(priv, SH1_SCI_SSR_OFFSET) & SH1_SCISSR_TDRE) != 0; +} + +/**************************************************************************** + * Public Funtions + ****************************************************************************/ + +/**************************************************************************** + * Name: up_serialinit + * + * Description: + * Performs the low level SCI initialization early in + * debug so that the serial console will be available + * during bootup. This must be called before up_serialinit. + * + ****************************************************************************/ + +void up_earlyserialinit(void) +{ + /* NOTE: All GPIO configuration for the SCIs was performed in + * up_lowsetup + */ + + /* Disable all UARTS */ + + up_disableuartint(TTYS0_DEV.priv, NULL); + up_disableuartint(TTYS1_DEV.priv, NULL); + + /* Configuration whichever one is the console */ + +#ifdef HAVE_CONSOLE + CONSOLE_DEV.isconsole = TRUE; + up_setup(&CONSOLE_DEV); +#endif +} + +/**************************************************************************** + * Name: up_serialinit + * + * Description: + * Register serial console and serial ports. This assumes + * that up_earlyserialinit was called previously. + * + ****************************************************************************/ + +void up_serialinit(void) +{ + /* Register the console */ + +#ifdef HAVE_CONSOLE + (void)uart_register("/dev/console", &CONSOLE_DEV); +#endif + + /* Register all SCIs */ + + (void)uart_register("/dev/ttyS0", &TTYS0_DEV); + (void)uart_register("/dev/ttyS1", &TTYS1_DEV); +} + +/**************************************************************************** + * Name: up_putc + * + * Description: + * Provide priority, low-level access to support OS debug writes + * + ****************************************************************************/ + +int up_putc(int ch) +{ +#ifdef HAVE_CONSOLE + struct up_dev_s *priv = (struct up_dev_s*)CONSOLE_DEV.priv; + ubyte scr; + + up_disableuartint(priv, &scr); + up_waittxready(priv); + up_serialout(priv, SH1_SCI_THR_OFFSET, (ubyte)ch); + + /* Check for LF */ + + if (ch == '\n') + { + /* Add CR */ + + up_waittxready(priv); + up_serialout(priv, SH1_SCI_THR_OFFSET, '\r'); + } + + up_waittxready(priv); + up_restoreuartint(priv, scr); +#endif + return ch; +} + +#else /* CONFIG_USE_SERIALDRIVER */ + +/**************************************************************************** + * Name: up_putc + * + * Description: + * Provide priority, low-level access to support OS debug writes + * + ****************************************************************************/ + +int up_putc(int ch) +{ +#ifdef HAVE_CONSOLE + /* Check for LF */ + + if (ch == '\n') + { + /* Add CR */ + + up_lowputc('\r'); + } + + up_lowputc(ch); +#endif + return ch; +} + +#endif /* CONFIG_USE_SERIALDRIVER */ |