rik freije / Mbed 2 deprecated MTi-1_rikbeun

rikbeuncode

Dependencies:   mbed-rtos mbed Xbus

Fork of MTi-1_example by Xsens

Diff: main.cpp

Revision:
20:38560fa3d2eb
Parent:
16:4bdcdac223d8
Child:
22:3eab999c5076
--- a/main.cpp	Tue May 19 15:49:29 2015 +0200
+++ b/main.cpp	Tue May 19 15:51:47 2015 +0200
@@ -42,6 +42,10 @@
 		case 'm':
 			sendCommand(XMID_GotoMeasurement);
 			break;
+
+		case 'd':
+			sendCommand(XMID_ReqDid);
+			break;
 	}
 }
 
@@ -76,6 +80,10 @@
 		}
 		pc.printf("\n");
 	}
+	else if (message->mid == XMID_DeviceId)
+	{
+		pc.printf("Device ID: %8X\n", *(uint32_t*)message->data);
+	}
 	else
 	{
 		pc.printf("Received Xbus message. MID=%X, length=%d\n", message->mid, message->length);