Track target

This commit is contained in:
Ryan Manley
2022-03-21 19:30:51 -06:00
parent f8092825f6
commit 065e48fed1
2 changed files with 10 additions and 0 deletions
@@ -67,6 +67,7 @@ public class TrackTarget extends CommandBase {
@Override
public void execute() {
try {
m_visionOdometry.setDriverMode(false);
m_visionOdometry.setLEDs(true);
points = m_visionOdometry.getTargetPoints();
@@ -153,6 +154,8 @@ public class TrackTarget extends CommandBase {
// Called once the command ends or is interrupted.
@Override
public void end(boolean interrupted) {
m_visionOdometry.setLEDs(false);
m_visionOdometry.setDriverMode(true);
}
// Returns true when the command should end.