Disable coil functions codes

Disable coil functions code and return an "Illegal function"
Created a mb error function & optimized the code

There is an modbus_error(type) function to throw errors (they are
defined at mb_main.h) and the code was organized and optimized