Vision code to identify cone, orientation of cone, calculate distance and angle

[jogray72]

Within 2 meters of a cone, the robot can use vision to obtain the yaw.