Terminal approach + AprilTagVisionSubsystemExtended

[kujo27]

Why are we doing this?

Allows us to drive to the nearest reef face to score using SwerveSimpleTrajectoryCommand and apriltags. Also, created a subsystem to be able to simulate in advantagescope
Asana task URL:
https://app.asana.com/0/1208731987242938/1209104793195512/f

Whats changing?

New files are added: DriveToNearestReefFaceCommand, AlignToReefWithAprilTagCommand, DriveToNearestReefFaceCommandGroup, MockAprilTagVisionSubsytem

Questions/notes for reviewers

Need to push some changes to SCL for there to be no errors ( new move() in BaseSwerveDriveSubsystem, and make inputs[] public in AprilTagVisionSubsystem )

How this was tested

• unit tests added
• tested on robot

---

PR feedback legend

Symbol	Meaning
⭐ ⭐ ⭐	must be addressed
⭐ ⭐	should be addressed
⭐	something to consider, a good idea

[Copilot]

Copilot reviewed 4 out of 4 changed files in this pull request and generated 1 comment.

Comments suppressed due to low confidence (1)

src/main/java/competition/subsystems/drive/commands/DriveToNearestReefFaceCommand.java:58

• The variable 'aKitLog' is used but not defined in the provided diff. Ensure 'aKitLog' is defined and initialized properly.

aKitLog.record("targetReefFacePose", targetReefFacePose);