Vision processing

[Alan Anderson]

If you know the location in the camera image of the pole you want to reach, and you know the location of "straight ahead" on the robot, you can compute the angle the robot needs to turn in order to aim for that pole.

If you know the height of the target in the camera image, you can compute the distance to the target using some simple trigonometry.

Use the turn angle and the drive distance to derive inputs to an Arcade Drive function.