FRDM-KL25Zand Xsens MTi-3
Dependencies: mbed mbed-rtos Xbus
Diff: main.cpp
- Revision:
- 34:3d7a6519a256
- Parent:
- 32:fafe0f42d82b
- Child:
- 35:7e519b88c610
diff -r 542e4b568631 -r 3d7a6519a256 main.cpp --- a/main.cpp Thu May 21 12:19:08 2015 +0200 +++ b/main.cpp Thu May 21 12:19:50 2015 +0200 @@ -33,7 +33,7 @@ } } -XbusMessage const* doTransaction(XbusMessage* m) +static void sendMessage(XbusMessage const* m) { uint8_t buf[64]; size_t rawLength = XbusMessage_format(buf, m); @@ -41,6 +41,11 @@ { mt.putc(buf[i]); } +} + +static XbusMessage const* doTransaction(XbusMessage const* m) +{ + sendMessage(m); osEvent ev = g_responseQueue.get(500); return ev.status == osEventMessage ? (XbusMessage*)ev.value.p : NULL;