AP_NavEKF2: honour AP_BEACON_ENABLED

if the DAL cuts its APIs out based on AP_BEACON_ENABLED we have to modify EKF2 to not use those APIs

libraries/AP_NavEKF2/AP_NavEKF2_Logging.cpp

@@ -199,6 +199,7 @@ void NavEKF2_core::Log_Write_Quaternion(uint64_t time_us) const
     AP::logger().WriteBlock(&pktq1, sizeof(pktq1));
 }
 
+#if AP_BEACON_ENABLED
 void NavEKF2_core::Log_Write_Beacon(uint64_t time_us)
 {
     if (core_index != frontend->primary) {
@@ -248,6 +249,7 @@ void NavEKF2_core::Log_Write_Beacon(uint64_t time_us)
     AP::logger().WriteBlock(&pkt0, sizeof(pkt0));
     rngBcnFuseDataReportIndex++;
 }
+#endif  // AP_BEACON_ENABLED
 
 void NavEKF2_core::Log_Write_Timing(uint64_t time_us)
 {
@@ -314,8 +316,10 @@ void NavEKF2_core::Log_Write(uint64_t time_us)
     Log_Write_Quaternion(time_us);
     Log_Write_GSF(time_us);
 
+#if AP_BEACON_ENABLED
     // write range beacon fusion debug packet if the range value is non-zero
     Log_Write_Beacon(time_us);
+#endif
 
     Log_Write_Timing(time_us);
 }

libraries/AP_NavEKF2/AP_NavEKF2_Measurements.cpp

@@ -795,6 +795,7 @@ void NavEKF2_core::readAirSpdData()
 *              Range Beacon Measurements                *
 ********************************************************/
 
+#if AP_BEACON_ENABLED
 // check for new range beacon data and push to data buffer if available
 void NavEKF2_core::readRngBcnData()
 {
@@ -901,6 +902,7 @@ void NavEKF2_core::readRngBcnData()
     rngBcnDataToFuse = storedRangeBeacon.recall(rngBcnDataDelayed,imuDataDelayed.time_ms);
 
 }
+#endif  // AP_BEACON_ENABLED
 
 /*
   update timing statistics structure

libraries/AP_NavEKF2/AP_NavEKF2_RngBcnFusion.cpp

@@ -5,6 +5,7 @@
 *                   FUSE MEASURED_DATA                  *
 ********************************************************/
 
+#if AP_BEACON_ENABLED
 // select fusion of range beacon measurements
 void NavEKF2_core::SelectRngBcnFusion()
 {
@@ -570,3 +571,4 @@ void NavEKF2_core::CalcRangeBeaconPosDownOffset(ftype obsVar, Vector3F &vehicleP
 
 }
 
+#endif  // AP_BEACON_ENABLED

libraries/AP_NavEKF2/AP_NavEKF2_core.cpp

@@ -573,8 +573,10 @@ void NavEKF2_core::UpdateFilter(bool predict)
         // Muat be run after SelectVelPosFusion() so that fresh GPS data is available
         runYawEstimatorCorrection();
 
+#if AP_BEACON_ENABLED
         // Update states using range beacon data
         SelectRngBcnFusion();
+#endif
 
         // Update states using optical flow data
         SelectFlowFusion();