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 } }