Working on Modbus/TCP implementation (not compiling and if it does, not working)