EtherCAT slave that reads 3 Xsens IMU's connected to a Xbus Master
Dependencies: MODSERIAL mbed KL25Z_ClockControl
Fork of EtherCAT by
Diff: soes.cpp
- Revision:
- 40:0528d79e63f2
- Parent:
- 39:8c5329c37de1
- Child:
- 41:e307b3dcab55
--- a/soes.cpp Fri Sep 11 14:20:31 2015 +0000 +++ b/soes.cpp Fri Sep 11 15:15:46 2015 +0000 @@ -70,7 +70,7 @@ //MODSERIAL pc(USBTX,USBRX,512); DigitalOut ploep(PTA13); -#define PLOEP do{ploep = !(ploep);}while(0); +//#define PLOEP do{ploep = !(ploep);}while(0); /* Private function prototypes -----------------------------------------------*/ /* Private functions ---------------------------------------------------------*/ @@ -274,10 +274,10 @@ { const int num_bytes = 50;//4 floats * 4 bytes //memcpy_byteswap((uint8_t *)&local_Rb.first.timestamp ,&xbus_master.rx.buffer[4], 2); - memcpy_floatswap((uint8_t *)&local_Rb.xsens_imu[sensor].q0,&xbus_master.rx.buffer[6+(sensor*num_bytes)], num_bytes); - memcpy_byteswap((uint8_t *)&local_Rb.xsens_imu[sensor].samplecounter,&xbus_master.rx.buffer[6+num_bytes+(sensor*num_bytes)],2); + //memcpy_floatswap((uint8_t *)&local_Rb.xsens_imu[sensor].q0,&xbus_master.rx.buffer[6+(sensor*num_bytes)], num_bytes); + //memcpy_byteswap((uint8_t *)&local_Rb.xsens_imu[sensor].samplecounter,&xbus_master.rx.buffer[6+num_bytes+(sensor*num_bytes)],2); //pc.printf("%x %x\n",Rb.timestamp, *((uint16_t *)(&xbus_master.rx.buffer[4]))); - PLOEP; + //PLOEP; } } xbus_master.rx.checksum_ok = 0;