FRDM-KL25Zand Xsens MTi-3
Dependencies: mbed mbed-rtos Xbus
Diff: main.cpp
- Revision:
- 15:558d279addd9
- Parent:
- 14:155f9a55ec51
- Child:
- 16:4bdcdac223d8
--- a/main.cpp Tue May 19 13:29:34 2015 +0200 +++ b/main.cpp Tue May 19 13:34:37 2015 +0200 @@ -56,22 +56,22 @@ static void mtDataHandler(struct XbusMessage const* message) { - if (message->mid == MTDATA2_MESSAGE_ID) + if (message->mid == XMID_MtData2) { pc.printf("MTData2:"); uint16_t counter; - if (MtData2_getItem(&counter, XDI_PacketCounter, message->data, message->length)) + if (MtData2_getItem(&counter, XDI_PacketCounter, message)) { pc.printf(" Packet counter: %5d", counter); } float ori[4]; - if (MtData2_getItem(ori, XDI_Quaternion, message->data, message->length)) + if (MtData2_getItem(ori, XDI_Quaternion, message)) { pc.printf(" Orientation: (% .3f, % .3f, % .3f, % .3f)", ori[0], ori[1], ori[2], ori[3]); } uint32_t status; - if (MtData2_getItem(&status, XDI_StatusWord, message->data, message->length)) + if (MtData2_getItem(&status, XDI_StatusWord, message)) { pc.printf(" Status:%X", status); }