zrzk
/
px4_autopilot
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
Browse Source

px4fmu-v5:extend board_rc_input to pass UxART

sbg
David Sidrane 7 years ago committed by Lorenz Meier
parent
bf36d272bf
commit
8cc358dff8
1 changed files with 6 additions and 6 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Split View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 12
      src/drivers/boards/px4fmu-v5/init.c

12
src/drivers/boards/px4fmu-v5/init.c
Unescape View File

@ -114,20 +114,20 @@ __END_DECLS @@ -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) @@ -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);
}

Write Preview
Loading…
Cancel
Save