Update Vision Files

[marcjuguilon]

Using the new Vision Files and updating its logging, commands built for this season, etc.

[marcjuguilon]

Notes:
AlignToVisionTarget along with other commands(i.e. AlignWithPose & DriveToVisionTarget) under the vision folder need to be rewritten since PIDCommand is marked for removal

Working on adding logging to visionstates

Vision still needs to be tested along with its config values on actual

[marcjuguilon]

Citing: https://www.chiefdelphi.com/t/need-help-getting-pidcommand-working/452333/5 and https://www.chiefdelphi.com/t/command-based-help/446143/19 for reference on building PID controllers instead of PIDCommand

wpilib (2025) documentation: https://github.wpilib.org/allwpilib/docs/release/java/edu/wpi/first/math/controller/PIDController.html

[marcjuguilon]

Update: Plan to process the commands directly into vision using PID controller to reroute our position with vision instead

[marcjuguilon]

Seperated the four main configs (ideas, smth cause there's no name for the separation yet) for Vision.java:

Config (Command Config)- used to build each seperate command's PID command values and offsets

VisionStates Commands- commands used directly into vision states

Vision Commands- built to send commands between Vision commands, basically a transit between config methods and Vision Command