Vision Java Testing

[matunkar]

Testing Java vision code

• [x] merge main i guess
• [ ] verify the camera stream on the robot works right while moving (fov)
• [x] edit/add drive to x commands to the driver joystick
• [ ] Test drive to april tag command on the amp april tag (teleop)
• [ ] Test drive to note command on stationary note (teleop)
• [ ] Test dtn command into acquisition command (auton sequence)
• [ ] Test dta command into score command (auton sequence)
• [ ] trap?

testing for auton integration should prob be on a different branch after the base commands are commited to main