fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-20 09:23:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

land_detector: do not publish if landing or freefall state has not changed

Browse Source 
Signed-off-by: tumbili <roman@px4.io> and bkueng <beat-kueng@gmx.net>
This commit is contained in:
tumbili
2016-06-23 15:56:51 +02:00
parent 7dea8d4a24
commit 8026273cb0
1 changed files with 8 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/land_detector/LandDetector.cpp
+8 -10
View File
@@ -103,17 +103,15 @@ void LandDetector::cycle()
} }
LandDetectionResult current_state = update(); LandDetectionResult current_state = update();
bool landDetected = (current_state == LANDDETECTION_RES_LANDED);
bool freefallDetected = (current_state == LANDDETECTION_RES_FREEFALL);
_landDetected.timestamp = hrt_absolute_time(); if (_landDetectedPub == nullptr || _landDetected.landed != landDetected || _landDetected.freefall != freefallDetected) {
_landDetected.landed = (current_state == LANDDETECTION_RES_LANDED); _landDetected.timestamp = hrt_absolute_time();
_landDetected.freefall = (current_state == LANDDETECTION_RES_FREEFALL); _landDetected.landed = (current_state == LANDDETECTION_RES_LANDED);
_landDetected.freefall = (current_state == LANDDETECTION_RES_FREEFALL);
// publish the land detected broadcast int instance;
if (_landDetectedPub == nullptr) { orb_publish_auto(ORB_ID(vehicle_land_detected), &_landDetectedPub, &_landDetected, &instance, ORB_PRIO_DEFAULT);
_landDetectedPub = orb_advertise(ORB_ID(vehicle_land_detected), &_landDetected);
} else {
orb_publish(ORB_ID(vehicle_land_detected), (orb_advert_t)_landDetectedPub, &_landDetected);
} }
if (!_taskShouldExit) { if (!_taskShouldExit) {