geofence: add simple vertical check

This commit is contained in:
Thomas Gubler
2014-01-04 15:17:07 +01:00
parent ec60a254d2
commit 31d1f436ad
3 changed files with 10 additions and 4 deletions
@@ -108,7 +108,7 @@ bool MissionFeasibilityChecker::checkGeofence(dm_item_t dm_current, size_t nMiss
return false;
}
if (!geofence.inside(missionitem.lat, missionitem.lon)) {
if (!geofence.inside(missionitem.lat, missionitem.lon, missionitem.altitude)) { //xxx: handle relative altitude
mavlink_log_info(_mavlink_fd, "#audio: Geofence violation waypoint %d", i);
return false;
}