4fd04b2371
Cherry picked fix from 15724
66 lines
1.9 KiB
C
66 lines
1.9 KiB
C
/* Copyright 2021
|
|
*
|
|
* This program 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.
|
|
*
|
|
* This program 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 <https://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include "uart.h"
|
|
|
|
#include "quantum.h"
|
|
|
|
#if defined(WB32F3G71xx)
|
|
static SerialConfig serialConfig = {SERIAL_DEFAULT_BITRATE, SD1_WRDLEN, SD1_STPBIT, SD1_PARITY, SD1_ATFLCT};
|
|
#else
|
|
static SerialConfig serialConfig = {SERIAL_DEFAULT_BITRATE, SD1_CR1, SD1_CR2, SD1_CR3};
|
|
#endif
|
|
|
|
void uart_init(uint32_t baud) {
|
|
static bool is_initialised = false;
|
|
|
|
if (!is_initialised) {
|
|
is_initialised = true;
|
|
|
|
serialConfig.speed = baud;
|
|
|
|
#if defined(USE_GPIOV1)
|
|
palSetLineMode(SD1_TX_PIN, PAL_MODE_ALTERNATE_OPENDRAIN);
|
|
palSetLineMode(SD1_RX_PIN, PAL_MODE_ALTERNATE_OPENDRAIN);
|
|
#else
|
|
palSetLineMode(SD1_TX_PIN, PAL_MODE_ALTERNATE(SD1_TX_PAL_MODE) | PAL_OUTPUT_TYPE_OPENDRAIN);
|
|
palSetLineMode(SD1_RX_PIN, PAL_MODE_ALTERNATE(SD1_RX_PAL_MODE) | PAL_OUTPUT_TYPE_OPENDRAIN);
|
|
#endif
|
|
sdStart(&SERIAL_DRIVER, &serialConfig);
|
|
}
|
|
}
|
|
|
|
void uart_write(uint8_t data) {
|
|
sdPut(&SERIAL_DRIVER, data);
|
|
}
|
|
|
|
uint8_t uart_read(void) {
|
|
msg_t res = sdGet(&SERIAL_DRIVER);
|
|
|
|
return (uint8_t)res;
|
|
}
|
|
|
|
void uart_transmit(const uint8_t *data, uint16_t length) {
|
|
sdWrite(&SERIAL_DRIVER, data, length);
|
|
}
|
|
|
|
void uart_receive(uint8_t *data, uint16_t length) {
|
|
sdRead(&SERIAL_DRIVER, data, length);
|
|
}
|
|
|
|
bool uart_available(void) {
|
|
return !sdGetWouldBlock(&SERIAL_DRIVER);
|
|
}
|