327 lines
8.9 KiB
C
327 lines
8.9 KiB
C
/*
|
|
ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010 Giovanni Di Sirio.
|
|
|
|
This file is part of ChibiOS/RT.
|
|
|
|
ChibiOS/RT is free software; you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation; either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
ChibiOS/RT is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
/**
|
|
* @file STM8/serial_lld.c
|
|
* @brief STM8 low level serial driver code.
|
|
*
|
|
* @addtogroup STM8_SERIAL
|
|
* @{
|
|
*/
|
|
|
|
#include "ch.h"
|
|
#include "hal.h"
|
|
|
|
/* Because someone somewhere couldn't use the same name for the same thing.*/
|
|
#if STM8_PLATFORM == PLATFORM_STM8AF51AA
|
|
#define UART1_BRR1 USART_BRR1
|
|
#define UART1_BRR2 USART_BRR2
|
|
#define UART1_SR USART_SR
|
|
#define UART1_DR USART_DR
|
|
#define UART1_CR1 USART_CR1
|
|
#define UART1_CR2 USART_CR2
|
|
#define UART1_CR3 USART_CR3
|
|
#define UART1_CR4 USART_CR4
|
|
#define UART1_CR5 USART_CR5
|
|
|
|
#define UART3_BRR1 LINUART_BRR1
|
|
#define UART3_BRR2 LINUART_BRR2
|
|
#define UART3_SR LINUART_SR
|
|
#define UART3_DR LINUART_DR
|
|
#define UART3_CR1 LINUART_CR1
|
|
#define UART3_CR2 LINUART_CR2
|
|
#define UART3_CR3 LINUART_CR3
|
|
#define UART3_CR4 LINUART_CR4
|
|
#define UART3_CR5 LINUART_CR5
|
|
#define UART3_CR6 LINUART_CR6
|
|
#endif
|
|
|
|
#if CH_HAL_USE_SERIAL || defined(__DOXYGEN__)
|
|
|
|
/*===========================================================================*/
|
|
/* Driver exported variables. */
|
|
/*===========================================================================*/
|
|
|
|
/**
|
|
* @brief UART1 serial driver identifier.
|
|
*/
|
|
#if USE_STM8_UART1 || defined(__DOXYGEN__)
|
|
SerialDriver SD1;
|
|
#endif
|
|
|
|
/**
|
|
* @brief UART3 serial driver identifier.
|
|
*/
|
|
#if USE_STM8_UART3 || defined(__DOXYGEN__)
|
|
SerialDriver SD3;
|
|
#endif
|
|
|
|
/*===========================================================================*/
|
|
/* Driver local variables. */
|
|
/*===========================================================================*/
|
|
|
|
/**
|
|
* @brief Driver default configuration.
|
|
*/
|
|
static const SerialConfig default_config = {
|
|
BBR(SERIAL_DEFAULT_BITRATE),
|
|
SD_MODE_PARITY_NONE | SD_MODE_STOP_1
|
|
};
|
|
|
|
/*===========================================================================*/
|
|
/* Driver local functions. */
|
|
/*===========================================================================*/
|
|
|
|
static void set_error(SerialDriver *sdp, uint8_t sr) {
|
|
sdflags_t sts = 0;
|
|
|
|
if (sr & 0x08) /* OR bit. */
|
|
sts |= SD_OVERRUN_ERROR;
|
|
if (sr & 0x04) /* NF bit. */
|
|
sts |= SD_NOISE_ERROR;
|
|
if (sr & 0x02) /* FE bit. */
|
|
sts |= SD_FRAMING_ERROR;
|
|
if (sr & 0x01) /* PE bit. */
|
|
sts |= SD_PARITY_ERROR;
|
|
chSysLockFromIsr();
|
|
sdAddFlagsI(sdp, sts);
|
|
chSysUnlockFromIsr();
|
|
}
|
|
|
|
#if USE_STM8_UART1 || defined(__DOXYGEN__)
|
|
static void notify1(void) {
|
|
|
|
UART1_CR2 |= 0x80; /* TIEN bit. */
|
|
}
|
|
|
|
/**
|
|
* @brief UART1 initialization.
|
|
*
|
|
* @param[in] config architecture-dependent serial driver configuration
|
|
*/
|
|
static void uart1_init(const SerialConfig *config) {
|
|
|
|
UART1_BRR2 = ((uint8_t)(config->sc_brr >> 8) % (uint8_t)0xF0) |
|
|
((uint8_t)config->sc_brr & (uint8_t)0x0F);
|
|
UART1_BRR1 = (uint8_t)(config->sc_brr >> 4);
|
|
UART1_CR1 = config->sc_mode &
|
|
SD_MODE_PARITY; /* PIEN included. */
|
|
UART1_CR2 = 0x2C; /* RIEN | TEN | REN. */
|
|
UART1_CR3 = config->sc_mode & SD_MODE_STOP;
|
|
UART1_CR4 = 0;
|
|
UART1_CR5 = 0;
|
|
UART1_PSCR = 1;
|
|
(void)UART1_SR;
|
|
(void)UART1_DR;
|
|
}
|
|
|
|
/**
|
|
* @brief UART1 de-initialization.
|
|
*/
|
|
static void uart1_deinit(void) {
|
|
|
|
UART1_CR1 = 0x20; /* UARTD (low power). */
|
|
UART1_CR2 = 0;
|
|
UART1_CR3 = 0;
|
|
UART1_CR4 = 0;
|
|
UART1_CR5 = 0;
|
|
UART1_PSCR = 0;
|
|
}
|
|
#endif /* USE_STM8_UART1 */
|
|
|
|
#if USE_STM8_UART3 || defined(__DOXYGEN__)
|
|
static void notify3(void) {
|
|
|
|
UART1_CR2 |= 0x80; /* TIEN bit. */
|
|
}
|
|
|
|
/**
|
|
* @brief UART3 initialization.
|
|
*
|
|
* @param[in] config architecture-dependent serial driver configuration
|
|
*/
|
|
static void uart3_init(const SerialConfig *config) {
|
|
|
|
UART3_BRR2 = ((uint8_t)(config->sc_brr >> 8) % (uint8_t)0xF0) |
|
|
((uint8_t)config->sc_brr & (uint8_t)0x0F);
|
|
UART3_BRR1 = (uint8_t)(config->sc_brr >> 4);
|
|
UART3_CR1 = config->sc_mode &
|
|
SD_MODE_PARITY; /* PIEN included. */
|
|
UART3_CR2 = 0x2C; /* RIEN | TEN | REN. */
|
|
UART3_CR3 = config->sc_mode & SD_MODE_STOP;
|
|
UART3_CR4 = 0;
|
|
UART3_CR6 = 0;
|
|
(void)UART3_SR;
|
|
(void)UART3_DR;
|
|
}
|
|
|
|
/**
|
|
* @brief UART3 de-initialization.
|
|
*/
|
|
static void uart3_deinit(void) {
|
|
|
|
UART3_CR1 = 0x20; /* UARTD (low power). */
|
|
UART3_CR2 = 0;
|
|
UART3_CR3 = 0;
|
|
UART3_CR4 = 0;
|
|
UART3_CR6 = 0;
|
|
}
|
|
#endif /* USE_STM8_UART3 */
|
|
|
|
/*===========================================================================*/
|
|
/* Driver interrupt handlers. */
|
|
/*===========================================================================*/
|
|
|
|
#if USE_STM8_UART1 || defined(__DOXYGEN__)
|
|
CH_IRQ_HANDLER(17) {
|
|
msg_t b;
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
chSysLockFromIsr();
|
|
b = sdRequestDataI(&SD1);
|
|
chSysUnlockFromIsr();
|
|
if (b < Q_OK)
|
|
UART1_CR2 &= ~0x80; /* TIEN. */
|
|
else
|
|
UART1_DR = b;
|
|
|
|
CH_IRQ_EPILOGUE();
|
|
}
|
|
|
|
CH_IRQ_HANDLER(18) {
|
|
uint8_t sr = UART1_SR;
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
if ((sr = UART1_SR) & 0x0F) /* OR | BF | FE | PE. */
|
|
set_error(&SD1, sr);
|
|
chSysLockFromIsr();
|
|
sdIncomingDataI(&SD1, UART1_DR);
|
|
chSysUnlockFromIsr();
|
|
|
|
CH_IRQ_EPILOGUE();
|
|
}
|
|
#endif /* USE_STM8_UART1 */
|
|
|
|
#if USE_STM8_UART3 || defined(__DOXYGEN__)
|
|
CH_IRQ_HANDLER(20) {
|
|
msg_t b;
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
chSysLockFromIsr();
|
|
b = sdRequestDataI(&SD3);
|
|
chSysUnlockFromIsr();
|
|
if (b < Q_OK)
|
|
UART3_CR2 &= ~0x80; /* TIEN. */
|
|
else
|
|
UART3_DR = b;
|
|
|
|
CH_IRQ_EPILOGUE();
|
|
}
|
|
|
|
CH_IRQ_HANDLER(21) {
|
|
uint8_t sr = UART3_SR;
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
if ((sr = UART3_SR) & 0x0F) /* OR | BF | FE | PE. */
|
|
set_error(&SD3, sr);
|
|
chSysLockFromIsr();
|
|
sdIncomingDataI(&SD3, UART3_DR);
|
|
chSysUnlockFromIsr();
|
|
|
|
CH_IRQ_EPILOGUE();
|
|
}
|
|
#endif /* USE_STM8_UART3 */
|
|
|
|
/*===========================================================================*/
|
|
/* Driver exported functions. */
|
|
/*===========================================================================*/
|
|
|
|
/**
|
|
* @brief Low level serial driver initialization.
|
|
*/
|
|
void sd_lld_init(void) {
|
|
|
|
#if USE_STM8_UART1
|
|
sdObjectInit(&SD1, NULL, notify1);
|
|
CLK_PCKENR1 |= 4; /* PCKEN12, clock source. */
|
|
UART1_CR1 = 0x20; /* UARTD (low power). */
|
|
#endif
|
|
|
|
#if USE_STM8_UART3
|
|
sdObjectInit(&SD3, NULL, notify3);
|
|
CLK_PCKENR1 |= 8; /* PCKEN13, clock source. */
|
|
UART3_CR1 = 0x20; /* UARTD (low power). */
|
|
#endif
|
|
}
|
|
|
|
/**
|
|
* @brief Low level serial driver configuration and (re)start.
|
|
*
|
|
* @param[in] sdp pointer to a @p SerialDriver object
|
|
*/
|
|
void sd_lld_start(SerialDriver *sdp) {
|
|
|
|
if (sdp->config == NULL)
|
|
sdp->config = &default_config;
|
|
|
|
#if USE_STM8_UART1
|
|
if (&SD1 == sdp) {
|
|
uart1_init(sdp->config);
|
|
return;
|
|
}
|
|
#endif
|
|
#if USE_STM8_UART3
|
|
if (&SD3 == sdp) {
|
|
uart3_init(sdp->config);
|
|
return;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
/**
|
|
* @brief Low level serial driver stop.
|
|
* @details De-initializes the USART, stops the associated clock, resets the
|
|
* interrupt vector.
|
|
*
|
|
* @param[in] sdp pointer to a @p SerialDriver object
|
|
*/
|
|
void sd_lld_stop(SerialDriver *sdp) {
|
|
|
|
#if USE_STM8_UART1
|
|
if (&SD1 == sdp) {
|
|
uart1_deinit();
|
|
return;
|
|
}
|
|
#endif
|
|
#if USE_STM8_UART3
|
|
if (&SD3 == sdp) {
|
|
uart3_deinit();
|
|
return;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
#endif /* CH_HAL_USE_SERIAL */
|
|
|
|
/** @} */
|