MODBUS libraries refactored and reasonably tested

Average delay of MODBUS_Slave in response to MODBUS message is less
than 7 ms.