Rewrite Yaw to CV Object

[drago314]

Motivation

As a developer, I want to:

What do we want the new feature to do?

I want this to be a more real-time approach to Yaw to CV Object by utilizing task-planning's step functionality. This would include

• updating the pid setpoint in realtime to the CV's angle, rather than rotating to the angle fully, then checking where our new goal is
• When searching for the object, consistently look for the object rather than turning 30 degrees and checking.

So that I can:

Why do we need this new feature?

This would make us faster to yaw to cv object at competition.

Timeline

When do we aim to have this project finished by?

Stretch Goal

Move to CV Object

Code written by pool test next week (11/22)

[drago314]

Ready for pool test in the new semester