Add Modbus RTU master/slave implementation + minor fixes