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

Dependencies:   MODSERIAL mbed KL25Z_ClockControl

Fork of EtherCAT by First Last

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;