SOES implementation i.c.w. ET1100 (Beckhoff ASIC)
Dependencies: KL25Z_ClockControl MODSERIAL mbed
Fork of EtherCAT-XbusMaster by
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;