examples/TestMasterSlave/Slave.c
changeset 378 d2abf6c8c27b
parent 343 118c1cabd0b0
child 381 854c43cdc24a
equal deleted inserted replaced
377:bea5a1576cbd 378:d2abf6c8c27b
    24 #include "Master.h"
    24 #include "Master.h"
    25 #include "TestMasterSlave.h"
    25 #include "TestMasterSlave.h"
    26 
    26 
    27 extern s_BOARD SlaveBoard;
    27 extern s_BOARD SlaveBoard;
    28 /*****************************************************************************/
    28 /*****************************************************************************/
    29 void TestSlave_heartbeatError(UNS8 heartbeatID)
    29 void TestSlave_heartbeatError(CO_Data* d, UNS8 heartbeatID)
    30 {
    30 {
    31 	eprintf("TestSlave_heartbeatError %d\n", heartbeatID);
    31 	eprintf("TestSlave_heartbeatError %d\n", heartbeatID);
    32 }
    32 }
    33 
    33 
    34 void TestSlave_initialisation()
    34 void TestSlave_initialisation(CO_Data* d)
    35 {
    35 {
    36 	eprintf("TestSlave_initialisation\n");
    36 	eprintf("TestSlave_initialisation\n");
    37 }
    37 }
    38 
    38 
    39 void TestSlave_preOperational()
    39 void TestSlave_preOperational(CO_Data* d)
    40 {
    40 {
    41 	eprintf("TestSlave_preOperational\n");
    41 	eprintf("TestSlave_preOperational\n");
    42 }
    42 }
    43 
    43 
    44 void TestSlave_operational()
    44 void TestSlave_operational(CO_Data* d)
    45 {
    45 {
    46 	eprintf("TestSlave_operational\n");
    46 	eprintf("TestSlave_operational\n");
    47 }
    47 }
    48 
    48 
    49 void TestSlave_stopped()
    49 void TestSlave_stopped(CO_Data* d)
    50 {
    50 {
    51 	eprintf("TestSlave_stopped\n");
    51 	eprintf("TestSlave_stopped\n");
    52 }
    52 }
    53 
    53 
    54 void TestSlave_post_sync()
    54 void TestSlave_post_sync(CO_Data* d)
    55 {
    55 {
    56       eprintf("TestSlave_post_sync\n");
    56       eprintf("TestSlave_post_sync\n");
    57       
    57       
    58       SlaveMap1=1;
    58       SlaveMap1=1;
    59       SlaveMap2=1;
    59       SlaveMap2=1;
    81       	SlaveMap11, 
    81       	SlaveMap11, 
    82       	SlaveMap12,
    82       	SlaveMap12,
    83       	SlaveMap13);
    83       	SlaveMap13);
    84 }
    84 }
    85 
    85 
    86 void TestSlave_post_TPDO()
    86 void TestSlave_post_TPDO(CO_Data* d)
    87 {
    87 {
    88         SlaveMap13 += 1;
    88         SlaveMap13 += 1;
    89 	eprintf("TestSlave_post_TPDO\n");
    89 	eprintf("TestSlave_post_TPDO\n");
    90 	
    90 	
    91 	/* send an error and recover inmediately every 12 cycles */
    91 	/* send an error and recover inmediately every 12 cycles */
    94 		EMCY_setError(&TestSlave_Data, 0x4200, 0x08, 0x0000);
    94 		EMCY_setError(&TestSlave_Data, 0x4200, 0x08, 0x0000);
    95 		EMCY_errorRecovered(&TestSlave_Data, 0x4200);
    95 		EMCY_errorRecovered(&TestSlave_Data, 0x4200);
    96 	}
    96 	}
    97 }
    97 }
    98 
    98 
    99 void TestSlave_storeODSubIndex(UNS16 wIndex, UNS8 bSubindex)
    99 void TestSlave_storeODSubIndex(CO_Data* d, UNS16 wIndex, UNS8 bSubindex)
   100 {
   100 {
   101 	/*TODO : 
   101 	/*TODO : 
   102 	 * - call getODEntry for index and subindex, 
   102 	 * - call getODEntry for index and subindex, 
   103 	 * - save content to file, database, flash, nvram, ...
   103 	 * - save content to file, database, flash, nvram, ...
   104 	 * 
   104 	 * 
   108 	 * 
   108 	 * 
   109 	 * */
   109 	 * */
   110 	eprintf("TestSlave_storeODSubIndex : %4.4x %2.2x\n", wIndex,  bSubindex);
   110 	eprintf("TestSlave_storeODSubIndex : %4.4x %2.2x\n", wIndex,  bSubindex);
   111 }
   111 }
   112 
   112 
   113 void TestSlave_post_emcy(UNS8 nodeID, UNS16 errCode, UNS8 errReg)
   113 void TestSlave_post_emcy(CO_Data* d, UNS8 nodeID, UNS16 errCode, UNS8 errReg)
   114 {
   114 {
   115 	eprintf("Slave received EMCY message. Node: %2.2x  ErrorCode: %4.4x  ErrorRegister: %2.2x\n", nodeID, errCode, errReg);
   115 	eprintf("Slave received EMCY message. Node: %2.2x  ErrorCode: %4.4x  ErrorRegister: %2.2x\n", nodeID, errCode, errReg);
   116 }
   116 }
   117 
   117 
   118 void TestSlave_StoreConfiguration(UNS8 *error, UNS8 *spec_error)
   118 void TestSlave_StoreConfiguration(UNS8 *error, UNS8 *spec_error)