Implement Vision Subsystem on the Physical Robot

[coderabbitai]

Background

The vision subsystem is currently commented out in the robot code (see PR #21), but multiple commands still depend on it:

• AutoAimAndShoot Command
• AutoAimCommand
• AimCommand
• DriveToPose2d Command

Task

Implement and test the vision subsystem on the physical robot to enable these vision-dependent features to work properly.

Implementation Details

• Re-enable the vision subsystem registration in the CommandScheduler
• Test vision-based targeting and commands on the physical robot
• Ensure all vision-dependent commands function as expected

Created based on discussion in PR #21.