Copied RobotC functions from LabVIEW