DriverAssistant runs two PID controllers to orient the robot toward the target and to drive the robot forward to within a few inches.
The idea is to use vision angle reports and sonar range reports to provide feedback for the two algorithms. While the 'A' button is pressed the DriverAssistant takes over using the two remote sensors. When it is released, the DriverAssistant aborts.
DriverAssistant runs two PID controllers to orient the robot toward the target and to drive the robot forward to within a few inches.
The idea is to use vision angle reports and sonar range reports to provide feedback for the two algorithms. While the 'A' button is pressed the DriverAssistant takes over using the two remote sensors. When it is released, the DriverAssistant aborts.