Emaxx Navigation Group / decawave_networking

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Diff: decawave_network.cpp

Revision:
6:fcb5b7ec8ab2
Parent:
3:1caa9d659257
--- a/decawave_network.cpp	Thu May 25 17:21:11 2017 +0000
+++ b/decawave_network.cpp	Wed May 31 19:54:23 2017 +0000
@@ -228,9 +228,13 @@
             if(msg.msgid == MAVLINK_MSG_ID_HEARTBEAT) {
                 mavlink_heartbeat_t hb_msg;
                 mavlink_msg_heartbeat_decode(&msg,&hb_msg);
-                printf("System ID %d Comp ID %d \r\n",msg.sysid,msg.compid);
+                printf("System ID %d Comp ID %d Base Mode %d\r\n",msg.sysid,msg.compid,hb_msg.base_mode);
                 nodes_in_range[msg.sysid]= msg.compid;
-                last_heartbeat[msg.sysid]=LocalTimer.read();                
+                last_heartbeat[msg.sysid]=LocalTimer.read();
+                
+                if(msg.compid == MASTER){
+                    curr_mode = hb_msg.base_mode;
+                }                
                 //    dwm_LED = !dwm_LED;
             }
             /* if(msg.msgid==MAVLINK_MSG_ID_FUSED_IMU) {