piotr/edgetx-gx12
1
0
Fork 0
Code Issues 2 Pull Requests Actions Packages Projects Releases Wiki Activity

[Taranis] SPORT Rx must be OFF when Tx is ON (otherwise it receives what

Browse Source 
it sends...)
This commit is contained in:
bsongis
2015-03-14 11:48:54 +01:00
parent fdb48528f9
commit d885807c11
1 changed files with 12 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
radio/src/targets/taranis/telemetry_driver.cpp
+12 -7
View File
@@ -97,6 +97,7 @@ void sportSendBuffer(uint8_t *buffer, uint32_t count)
sportTxBuffer.ptr = buffer ;
sportTxBuffer.count = count ;
GPIO_PIN_SPORT_ON->BSRRL = PIN_SPORT_ON ; // output enable
SPORT_USART->CR1 &= ~USART_CR1_RE ; // turn off receiver
SPORT_USART->CR1 |= USART_CR1_TXEIE ;
}
@@ -114,23 +115,27 @@ extern "C" void SPORT_IRQHandler()
if (sportTxBuffer.count) {
SPORT_USART->DR = *sportTxBuffer.ptr++;
if (--sportTxBuffer.count == 0) {
SPORT_USART->CR1 &= ~USART_CR1_TXEIE; // Stop Tx interrupt
SPORT_USART->CR1 |= USART_CR1_TCIE; // Enable complete interrupt
SPORT_USART->CR1 &= ~USART_CR1_TXEIE; // stop Tx interrupt
SPORT_USART->CR1 |= USART_CR1_TCIE; // enable complete interrupt
}
}
}
if (SPORT_USART->SR & USART_SR_TC) {
SPORT_USART->CR1 &= ~USART_CR1_TCIE ; // Stop Complete interrupt
if ((status & USART_SR_TC) && (SPORT_USART->CR1 & USART_CR1_TCIE))
SPORT_USART->CR1 &= ~USART_CR1_TCIE ; // stop Complete interrupt
GPIO_PIN_SPORT_ON->BSRRH = PIN_SPORT_ON ; // output disable
SPORT_USART->CR1 |= USART_CR1_RE ;
while (status & (USART_FLAG_RXNE)) {
status = SPORT_USART->DR;
status = SPORT_USART->SR ;
}
}
while (status & (USART_FLAG_RXNE | USART_FLAG_ERRORS)) {
data = SPORT_USART->DR;
if (!(status & USART_FLAG_ERRORS))
if (!(status & USART_FLAG_ERRORS)) {
telemetryFifo.push(data);
}
status = SPORT_USART->SR;
}
}