examples/TestMasterSlave/Slave.c
changeset 284 24bf3d692993
parent 236 905677ed00f3
child 296 03f2b8b8cb0b
--- a/examples/TestMasterSlave/Slave.c	Tue Sep 25 15:29:37 2007 +0200
+++ b/examples/TestMasterSlave/Slave.c	Wed Sep 26 16:02:00 2007 +0200
@@ -86,6 +86,13 @@
 {
         SlaveMap13 += 1;
 	eprintf("TestSlave_post_TPDO\n");
+	
+	/* send an error and recover inmediately every 12 cycles */
+	if(SlaveMap13 % 12 == 0)
+	{
+		EMCY_setError(&TestSlave_Data, 0x4200, 0x08);
+		EMCY_errorRecovered(&TestSlave_Data, 0x4200);
+	}
 }
 
 void TestSlave_storeODSubIndex(UNS16 wIndex, UNS8 bSubindex)
@@ -101,3 +108,8 @@
 	 * */
 	eprintf("TestSlave_storeODSubIndex : %4.4x %2.2x\n", wIndex,  bSubindex);
 }
+
+void TestSlave_post_emcy(UNS8 nodeID, UNS16 errCode, UNS8 errReg)
+{
+	eprintf("Slave received EMCY message. Node: %2.2x  ErrorCode: %4.4x  ErrorRegister: %2.2x\n", nodeID, errCode, errReg);
+}