aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

HAL_ChibiOS: implement parity and stop bits controls

Browse Source
This commit is contained in:
Andrew Tridgell 2018-01-22 09:31:22 +11:00
parent 2e15285c51
commit ad26ca4a27
2 changed files with 59 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

56
libraries/AP_HAL_ChibiOS/UARTDriver.cpp
View File

@ -694,4 +694,60 @@ bool UARTDriver::set_unbuffered_writes(bool on)
return true;
}
/*
setup parity
*/
void UARTDriver::configure_parity(uint8_t v)
{
if (sdef.is_usb) {
// not possible
return;
}
switch (v) {
case 0:
// no parity
sercfg.cr1 &= ~(USART_CR1_PCE | USART_CR1_PS);
break;
case 1:
// odd parity
sercfg.cr1 |= USART_CR1_PCE;
sercfg.cr1 |= USART_CR1_PS;
break;
case 2:
// even parity
sercfg.cr1 |= USART_CR1_PCE;
sercfg.cr1 &= ~USART_CR1_PS;
break;
}
// stop and start to take effect
sdStop((SerialDriver*)sdef.serial);
sdStart((SerialDriver*)sdef.serial, &sercfg);
}
/*
set stop bits
*/
void UARTDriver::set_stop_bits(int n)
{
if (sdef.is_usb) {
// not possible
return;
}
switch (n) {
case 1:
sercfg.cr2 = USART_CR2_STOP1_BITS;
break;
case 2:
sercfg.cr2 = USART_CR2_STOP2_BITS;
break;
}
// stop and start to take effect
sdStop((SerialDriver*)sdef.serial);
sdStart((SerialDriver*)sdef.serial, &sercfg);
}
#endif //CONFIG_HAL_BOARD == HAL_BOARD_CHIBIOS

3
libraries/AP_HAL_ChibiOS/UARTDriver.h
View File

@ -66,6 +66,9 @@ public:
// allow for low latency writes
bool set_unbuffered_writes(bool on) override;
void configure_parity(uint8_t v) override;
void set_stop_bits(int n) override;
private:
bool tx_bounce_buf_ready;