From 14f4e13e80fc1235429041a9c4b93ceb7a51c759 Mon Sep 17 00:00:00 2001 From: Pawel Jalocha Date: Sun, 5 May 2019 21:51:49 +0100 Subject: [PATCH] Send MAVlink ADS-B message to the GPS/MAVlink port --- main/proc.cpp | 15 ++++++++------- 1 file changed, 8 insertions(+), 7 deletions(-) diff --git a/main/proc.cpp b/main/proc.cpp index d6ce114..cd7dc56 100644 --- a/main/proc.cpp +++ b/main/proc.cpp @@ -280,13 +280,14 @@ static void ProcessRxPacket(OGN_RxPacket *RxPacket, uint8_t RxPacket Format_String(CONS_UART_Write, Line, 0, Len); xSemaphoreGive(CONS_Mutex); #endif -// #ifdef WITH_MAVLINK -// MAV_ADSB_VEHICLE MAV_RxReport; -// RxPacket->Packet.Encode(&MAV_RxReport); -// xSemaphoreTake(CONS_Mutex, portMAX_DELAY); -// MAV_RxMsg::Send(sizeof(MAV_RxReport), MAV_Seq++, MAV_SysID, MAV_COMP_ID_ADSB, MAV_ID_ADSB_VEHICLE, (const uint8_t *)&MAV_RxReport, CONS_UART_Write); -// xSemaphoreGive(CONS_Mutex); -// #endif +#ifdef WITH_MAVLINK + MAV_ADSB_VEHICLE MAV_RxReport; + RxPacket->Packet.Encode(&MAV_RxReport); + MAV_RxMsg::Send(sizeof(MAV_RxReport), MAV_Seq++, MAV_SysID, MAV_COMP_ID_ADSB, MAV_ID_ADSB_VEHICLE, (const uint8_t *)&MAV_RxReport, GPS_UART_Write); + // xSemaphoreTake(CONS_Mutex, portMAX_DELAY); + // MAV_RxMsg::Send(sizeof(MAV_RxReport), MAV_Seq++, MAV_SysID, MAV_COMP_ID_ADSB, MAV_ID_ADSB_VEHICLE, (const uint8_t *)&MAV_RxReport, CONS_UART_Write); + // xSemaphoreGive(CONS_Mutex); +#endif } }