130 lines
3.1 KiB
C++
130 lines
3.1 KiB
C++
/*
|
|
* Copyright (C) EdgeTX
|
|
*
|
|
* Based on code named
|
|
* opentx - https://github.com/opentx/opentx
|
|
* th9x - http://code.google.com/p/th9x
|
|
* er9x - http://code.google.com/p/er9x
|
|
* gruvin9x - http://code.google.com/p/gruvin9x
|
|
*
|
|
* License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
#include "bluetooth_driver.h"
|
|
#include "stm32_hal_ll.h"
|
|
|
|
#include "board.h"
|
|
#include "debug.h"
|
|
|
|
#if !defined(BOOT)
|
|
|
|
#include "stm32_serial_driver.h"
|
|
|
|
#define BT_USART_IRQ_PRIORITY 6
|
|
|
|
static const stm32_usart_t btUSART = {
|
|
.USARTx = BT_USART,
|
|
.GPIOx = BT_USART_GPIO,
|
|
.GPIO_Pin = BT_TX_GPIO_PIN | BT_RX_GPIO_PIN,
|
|
.IRQn = BT_USART_IRQn,
|
|
.IRQ_Prio = BT_USART_IRQ_PRIORITY,
|
|
.txDMA = nullptr,
|
|
.txDMA_Stream = 0,
|
|
.txDMA_Channel = 0,
|
|
.rxDMA = nullptr,
|
|
.rxDMA_Stream = 0,
|
|
.rxDMA_Channel = 0,
|
|
};
|
|
|
|
DEFINE_STM32_SERIAL_PORT(BTModule, btUSART, BT_RX_FIFO_SIZE, BT_TX_FIFO_SIZE);
|
|
|
|
#if defined(BLUETOOTH_PROBE)
|
|
volatile uint8_t btChipPresent = 0;
|
|
#endif
|
|
|
|
// const etx_serial_driver_t* _bt_usart_drv = nullptr;
|
|
void* _bt_usart_ctx = nullptr;
|
|
#endif
|
|
|
|
void bluetoothInit(uint32_t baudrate, bool enable)
|
|
{
|
|
#if defined(BT_EN_GPIO_PIN)
|
|
LL_GPIO_InitTypeDef pinInit;
|
|
LL_GPIO_StructInit(&pinInit);
|
|
|
|
pinInit.Pin = BT_EN_GPIO_PIN;
|
|
pinInit.Mode = LL_GPIO_MODE_OUTPUT;
|
|
pinInit.OutputType = LL_GPIO_OUTPUT_PUSHPULL;
|
|
pinInit.Pull = LL_GPIO_PULL_NO;
|
|
|
|
LL_GPIO_Init(BT_EN_GPIO, &pinInit);
|
|
#endif
|
|
|
|
#if !defined(BOOT)
|
|
etx_serial_init cfg = {
|
|
.baudrate = baudrate,
|
|
.encoding = ETX_Encoding_8N1,
|
|
.direction = ETX_Dir_TX_RX,
|
|
.polarity = ETX_Pol_Normal,
|
|
};
|
|
|
|
if (!_bt_usart_ctx) {
|
|
auto hw_def = REF_STM32_SERIAL_PORT(BTModule);
|
|
_bt_usart_ctx = STM32SerialDriver.init(hw_def, &cfg);
|
|
} else {
|
|
STM32SerialDriver.setBaudrate(_bt_usart_ctx, baudrate);
|
|
}
|
|
#endif
|
|
|
|
#if defined(BT_EN_GPIO_PIN)
|
|
if (enable) {
|
|
LL_GPIO_ResetOutputPin(BT_EN_GPIO, BT_EN_GPIO_PIN);
|
|
} else {
|
|
LL_GPIO_SetOutputPin(BT_EN_GPIO, BT_EN_GPIO_PIN);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
#if !defined(BOOT)
|
|
void bluetoothDisable()
|
|
{
|
|
#if defined(BT_EN_GPIO_PIN)
|
|
// close bluetooth (recent modules will go to bootloader mode)
|
|
LL_GPIO_SetOutputPin(BT_EN_GPIO, BT_EN_GPIO_PIN);
|
|
#endif
|
|
if (_bt_usart_ctx) {
|
|
STM32SerialDriver.deinit(_bt_usart_ctx);
|
|
_bt_usart_ctx = nullptr;
|
|
}
|
|
}
|
|
|
|
void bluetoothWrite(const void* buffer, uint32_t len)
|
|
{
|
|
if (!_bt_usart_ctx) return;
|
|
STM32SerialDriver.sendBuffer(_bt_usart_ctx, (const uint8_t*)buffer, len);
|
|
}
|
|
|
|
int bluetoothRead(uint8_t* data)
|
|
{
|
|
if (!_bt_usart_ctx) return 0;
|
|
return STM32SerialDriver.getByte(_bt_usart_ctx, data);
|
|
}
|
|
|
|
uint8_t bluetoothIsWriting(void)
|
|
{
|
|
if (!_bt_usart_ctx)
|
|
return false;
|
|
|
|
return !STM32SerialDriver.txCompleted(_bt_usart_ctx);
|
|
}
|
|
#endif // !BOOT
|