mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-05-09 22:49:53 +08:00
[sensors] update airspeed_otf to generic device
This commit is contained in:
@@ -22,9 +22,12 @@
|
||||
<periodic fun="airspeed_otf_periodic()" freq="1"/>
|
||||
<event fun="airspeed_otf_event()"/>
|
||||
<makefile target="ap">
|
||||
<raw>
|
||||
OTF_UART_LOWER=$(shell echo $(OTF_UART) | tr A-Z a-z)
|
||||
</raw>
|
||||
<file name="airspeed_otf.c"/>
|
||||
<define name="USE_$(OTF_UART)"/>
|
||||
<define name="MET_LINK" value="$(OTF_UART)"/>
|
||||
<define name="MET_LINK" value="$(OTF_UART_LOWER)"/>
|
||||
<define name="$(OTF_UART)_BAUD" value="B115200"/>
|
||||
</makefile>
|
||||
</module>
|
||||
|
||||
@@ -153,8 +153,8 @@ void airspeed_otf_init(void)
|
||||
|
||||
void airspeed_otf_event(void)
|
||||
{
|
||||
while (MetLink(ChAvailable())) {
|
||||
uint8_t ch = MetLink(Getch());
|
||||
while (MetBuffer()) {
|
||||
uint8_t ch = MetGetch();
|
||||
airspeed_otf_parse(ch);
|
||||
}
|
||||
}
|
||||
|
||||
@@ -37,17 +37,16 @@
|
||||
#ifndef SITL
|
||||
#include "mcu_periph/uart.h"
|
||||
|
||||
#define __MetLink(dev, _x) dev##_x
|
||||
#define _MetLink(dev, _x) __MetLink(dev, _x)
|
||||
#define MetLink(_x) _MetLink(MET_LINK, _x)
|
||||
#define MetLinkDevice (&(MET_LINK).device)
|
||||
|
||||
#define MetBuffer() MetLink(ChAvailable())
|
||||
#define ReadMetBuffer() { while (MetLink(ChAvailable())&&!met_msg_received) parse_met_buffer(MetLink(Getch())); }
|
||||
#define MetSend1(c) MetLink(Transmit(c))
|
||||
#define MetBuffer() MetLinkDevice->char_available(MetLinkDevice->periph)
|
||||
#define MetGetch() MetLinkDevice->getchar(MetLinkDevice->periph)
|
||||
#define ReadMetBuffer() { while (MetBuffer()&&!met_msg_received) parse_met_buffer(MetGetch()); }
|
||||
#define MetSend1(c) MetLinkDevice->transmit(MetLinkDevice->periph, c)
|
||||
#define MetUartSend1(c) MetSend1(c)
|
||||
#define MetSend(_dat,_len) { for (uint8_t i = 0; i< (_len); i++) MetSend1(_dat[i]); };
|
||||
#define MetUartSetBaudrate(_b) MetLink(SetBaudrate(_b))
|
||||
#define MetUartRunning MetLink(TxRunning)
|
||||
#define MetUartSetBaudrate(_b) uart_periph_set_baudrate(&(MET_LINK), _b)
|
||||
#define MetUartRunning (MET_LINK).tx_running
|
||||
|
||||
#endif /** !SITL */
|
||||
|
||||
|
||||
Reference in New Issue
Block a user