Terrain: set HAL capabilities bit

2015-07-30 15:43:10 +09:00 · 2015-07-30 15:43:10 +09:00 · 7d2c0079ff
parent d0aa1a89cd
commit 7d2c0079ff
1 changed files with 7 additions and 0 deletions
--- a/libraries/AP_Terrain/AP_Terrain.cpp
+++ b/libraries/AP_Terrain/AP_Terrain.cpp
@ -312,6 +312,13 @@ void AP_Terrain::update(void)

    // check for pending rally data
    update_rally_data();
+
+    // update capabilities
+    if (enable) {
+        hal.util->set_capabilities(MAV_PROTOCOL_CAPABILITY_TERRAIN);
+    } else {
+        hal.util->clear_capabilities(MAV_PROTOCOL_CAPABILITY_TERRAIN);
+    }
 }

 /*