Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-13 03:20:00 +03:00
Code Issues Wiki Activity

fix rtc6705 drive (#14296)

Browse source 
* fix rtc6705 drive

* Update rt6705 request suggestion
This commit is contained in:
LiuYongNan 2025-04-09 21:25:27 +08:00 • committed by GitHub
parent 609533a737
commit fd3a131797
No known key found for this signature in database
GPG key ID: B5690EEEBB952194
1 changed files with 8 additions and 6 deletions
Download patch file Download diff file Expand all files Collapse all files

14
src/main/drivers/vtx_rtc6705.c
View file

@ -95,7 +95,6 @@ static uint32_t reverse32(uint32_t in)
bool rtc6705IOInit(const vtxIOConfig_t *vtxIOConfig) bool rtc6705IOInit(const vtxIOConfig_t *vtxIOConfig)
{ {
static extDevice_t devInstance; static extDevice_t devInstance;
IO_t csnPin = IOGetByTag(vtxIOConfig->csTag); IO_t csnPin = IOGetByTag(vtxIOConfig->csTag);
if (!csnPin) { if (!csnPin) {
return false; return false;
@ -112,15 +111,16 @@ bool rtc6705IOInit(const vtxIOConfig_t *vtxIOConfig)
// RTC6705 when using SOFT SPI driver doesn't use an SPI device, so don't attempt to initialise an spiInstance. // RTC6705 when using SOFT SPI driver doesn't use an SPI device, so don't attempt to initialise an spiInstance.
SPI_TypeDef *spiInstance = spiInstanceByDevice(SPI_CFG_TO_DEV(vtxIOConfig->spiDevice)); SPI_TypeDef *spiInstance = spiInstanceByDevice(SPI_CFG_TO_DEV(vtxIOConfig->spiDevice));
if (spiInstance && spiSetBusInstance(dev, vtxIOConfig->spiDevice)) { if (spiInstance && spiSetBusInstance(&devInstance, vtxIOConfig->spiDevice)) {
devInstance.busType_u.spi.csnPin = csnPin; dev = &devInstance;
IOInit(devInstance.busType_u.spi.csnPin, OWNER_VTX_CS, 0); dev->busType_u.spi.csnPin = csnPin;
IOInit(dev->busType_u.spi.csnPin, OWNER_VTX_CS, 0);
DISABLE_RTC6705(); DISABLE_RTC6705();
// GPIO bit is enabled so here so the output is not pulled low when the GPIO is set in output mode. // GPIO bit is enabled so here so the output is not pulled low when the GPIO is set in output mode.
// Note: It's critical to ensure that incorrect signals are not sent to the VTX. // Note: It's critical to ensure that incorrect signals are not sent to the VTX.
IOConfigGPIO(devInstance.busType_u.spi.csnPin, IOCFG_OUT_PP); IOConfigGPIO(dev->busType_u.spi.csnPin, IOCFG_OUT_PP);
spiSetBusInstance(dev, vtxIOConfig->spiDevice);
return true; return true;
#if defined(USE_VTX_RTC6705_SOFTSPI) #if defined(USE_VTX_RTC6705_SOFTSPI)
} else { } else {
@ -141,6 +141,8 @@ static void rtc6705Transfer(uint32_t command)
// Perform bitwise reverse of the command. // Perform bitwise reverse of the command.
command = reverse32(command); command = reverse32(command);
command = ((command >> 24) & 0xFF) | (((command >> 16) & 0xFF) << 8) | (((command >> 8) & 0xFF) << 16) | (((command >> 0) & 0xFF) << 24);
spiReadWriteBuf(dev, (uint8_t *)&command, NULL, sizeof(command)); spiReadWriteBuf(dev, (uint8_t *)&command, NULL, sizeof(command));
delayMicroseconds(2); delayMicroseconds(2);