We need a subsystem that the autonomous system can use to find out where the gear target is.
Write a subsystem to use the camera and GripPipeline to extract the information:
Distance to the target
Angle that the robot needs to turn, to bring the target to the center
Angle that the target is facing, compared to the robot. If the robot is lined up perfectly, such that driving towards the target will make it hit the gear lifter rod straight on, this will be 0 degrees. Otherwise, it will be whatever angle the robot would hit the gear lifter rod at.
We need a subsystem that the autonomous system can use to find out where the gear target is.
Write a subsystem to use the camera and GripPipeline to extract the information: