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).

(binary:image/png)