First Last / Mbed 2 deprecated EtherCAT-XbusMaster

EtherCAT slave that reads 3 Xsens IMU's connected to a Xbus Master

Dependencies:   MODSERIAL mbed KL25Z_ClockControl

Fork of EtherCAT by First Last

Diff: soes.cpp

Revision:
37:d00717883d98
Parent:
33:b4844666684f
Child:
39:8c5329c37de1
--- a/soes.cpp	Fri Sep 11 11:49:14 2015 +0000
+++ b/soes.cpp	Fri Sep 11 11:55:46 2015 +0000
@@ -271,7 +271,7 @@
         		if(xbus_master.rx.buffer[2] == 0x32)
         		{
         			memcpy_byteswap((uint8_t *)&local_Rb.timestamp   ,&xbus_master.rx.buffer[4], 2);
-        			memcpy_floatswap((uint8_t *)&local_Rb.first.acc[0],&xbus_master.rx.buffer[6],xbus_master.rx.buffer[3] - 2);
+        			memcpy_floatswap((uint8_t *)&local_Rb.first.q0,&xbus_master.rx.buffer[6],xbus_master.rx.buffer[3] - 2);
         			//memcpy_byteswap((uint8_t *)&local_Rb.first.acc[0],&xbus_master.rx.buffer[6],xbus_master.rx.buffer[3] - 2);
         			//pc.printf("%x %x\n",Rb.timestamp, *((uint16_t *)(&xbus_master.rx.buffer[4])));
         			PLOEP;