Solved a small bug in emcy.c (errRegMask was always '1' in EMCY_setError.
EMCY_setError has a new parameter, addInfo, a 16-bit value that will be copied to 16 most significat bits in 1003h (but it is not sent in EMCY message).
#include "TestSlave.h"
void TestSlave_heartbeatError(UNS8);
UNS8 TestSlave_canSend(Message *);
void TestSlave_initialisation(void);
void TestSlave_preOperational(void);
void TestSlave_operational(void);
void TestSlave_stopped(void);
void TestSlave_post_sync(void);
void TestSlave_post_TPDO(void);
void TestSlave_storeODSubIndex(UNS16 wIndex, UNS8 bSubindex);
void TestSlave_post_emcy(UNS8 nodeID, UNS16 errCode, UNS8 errReg);