Restructured communication to work with PISockets. Should be ready for calling in RobotProject