Fixed write commands, added IEEE to float conversion, TODO: add option cases, set a way to recognize which registeries to convert, make position and orientation variables, cleanup getFloat32, clean echoPacket, add XML or json modules, confirm write in overwriteRegister()