Move robot code to subfolder
Basic MQTT communication is working