fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-18 11:03:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

px4fmu-v5:extend board_rc_input to pass UxART

Browse Source
This commit is contained in:
David Sidrane
2018-07-17 08:53:29 +02:00
committed by Lorenz Meier
parent bf36d272bf
commit 8cc358dff8
1 changed files with 6 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/boards/px4fmu-v5/init.c
+6 -6
View File
@@ -114,20 +114,20 @@ __END_DECLS
*
************************************************************************************/
__EXPORT void board_rc_input(bool invert_on)
__EXPORT void board_rc_input(bool invert_on, uint32_t uxart_base)
{
irqstate_t irqstate = px4_enter_critical_section();
uint32_t cr1 = getreg32(STM32_USART_CR1_OFFSET + RC_UXART_BASE);
uint32_t cr2 = getreg32(STM32_USART_CR2_OFFSET + RC_UXART_BASE);
uint32_t cr1 = getreg32(STM32_USART_CR1_OFFSET + uxart_base);
uint32_t cr2 = getreg32(STM32_USART_CR2_OFFSET + uxart_base);
uint32_t regval = cr1;
/* {R|T}XINV bit fields can only be written when the USART is disabled (UE=0). */
regval &= ~USART_CR1_UE;
putreg32(regval, STM32_USART_CR1_OFFSET + RC_UXART_BASE);
putreg32(regval, STM32_USART_CR1_OFFSET + uxart_base);
if (invert_on) {
cr2 |= (USART_CR2_RXINV | USART_CR2_TXINV);
@@ -136,8 +136,8 @@ __EXPORT void board_rc_input(bool invert_on)
cr2 &= ~(USART_CR2_RXINV | USART_CR2_TXINV);
}
putreg32(cr2, STM32_USART_CR2_OFFSET + RC_UXART_BASE);
putreg32(cr1, STM32_USART_CR1_OFFSET + RC_UXART_BASE);
putreg32(cr2, STM32_USART_CR2_OFFSET + uxart_base);
putreg32(cr1, STM32_USART_CR1_OFFSET + uxart_base);
leave_critical_section(irqstate);
}