diff --git a/conf/modules/airspeed_otf.xml b/conf/modules/airspeed_otf.xml index 6935d2f3a4..28229c085d 100644 --- a/conf/modules/airspeed_otf.xml +++ b/conf/modules/airspeed_otf.xml @@ -22,9 +22,12 @@ + + OTF_UART_LOWER=$(shell echo $(OTF_UART) | tr A-Z a-z) + - + diff --git a/sw/airborne/modules/sensors/airspeed_otf.c b/sw/airborne/modules/sensors/airspeed_otf.c index 94f7ff147c..5888dc7d65 100644 --- a/sw/airborne/modules/sensors/airspeed_otf.c +++ b/sw/airborne/modules/sensors/airspeed_otf.c @@ -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); } } diff --git a/sw/airborne/modules/sensors/met_module.h b/sw/airborne/modules/sensors/met_module.h index b6bd3b738c..68935abbab 100644 --- a/sw/airborne/modules/sensors/met_module.h +++ b/sw/airborne/modules/sensors/met_module.h @@ -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 */