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).
/*
Define the i/o port global symbol
*/
.globl _io_ports
_io_ports=0x0000
/*
0x0000 is the default mapping at reset. (it is 0x1000 for 68hc11)
*/