Full TCP/Modbus protocol implemented for write, still needs testing