Team4388/2022NoWayHome
1
0
Fork 0
mirror of https://github.com/Team4388/2022NoWayHome.git synced 2026-06-08 16:28:07 -06:00
Code Issues Packages Projects Releases Wiki Activity

Merge branch 'cleanup' of https://github.com/Team4388/2022NoWayHome into cleanup

Browse Source
This commit is contained in:
aarav18
2022-04-07 18:33:46 -06:00
parent a9a7b1bc68 c3660651ba
commit ea81f1720c
3 changed files with 7 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/main/java/frc4388/robot/Robot.java
+1 -1
View File
@@ -152,7 +152,7 @@ public class Robot extends TimedRobot {
@Override
public void disabledPeriodic() {
// m_robotContainer.m_robotVisionOdometry.setLEDs(false);
m_robotContainer.m_robotVisionOdometry.setLEDs(false);
}
/**
src/main/java/frc4388/robot/RobotContainer.java
+5 -5
View File
@@ -458,14 +458,14 @@ public class RobotContainer {
);
}
private SequentialCommandGroup shoot(double storageRunTime, double timeout) {
private ParallelRaceGroup shoot(double storageRunTime, double timeout) {
return new SequentialCommandGroup(
new TrackTarget(m_robotTurret, m_robotBoomBoom, m_robotHood, m_robotVisionOdometry, m_robotLED, true).withTimeout(timeout),
new TrackTarget(m_robotTurret, m_robotBoomBoom, m_robotHood, m_robotVisionOdometry, m_robotLED, true),
new ParallelCommandGroup(
new TrackTarget(m_robotTurret, m_robotBoomBoom, m_robotHood, m_robotVisionOdometry, m_robotLED, true).until(TrackTarget::isTargetNotLocked),
new TrackTarget(m_robotTurret, m_robotBoomBoom, m_robotHood, m_robotVisionOdometry, m_robotLED, true),
new RunCommandForTime(new RunCommand(() -> m_robotStorage.runStorage(StorageConstants.STORAGE_SPEED), m_robotStorage), storageRunTime, true)
)
);
).withTimeout(timeout + storageRunTime);
}
SequentialCommandGroup weirdAutoShootingGroup = new SequentialCommandGroup(new TrackTarget(m_robotTurret, m_robotBoomBoom, m_robotHood, m_robotVisionOdometry, m_robotLED, true),
@@ -496,7 +496,7 @@ public class RobotContainer {
SequentialCommandGroup extendThenAimTurret() {
return new SequentialCommandGroup(
new ExtenderIntakeGroup(m_robotIntake, m_robotExtender),
new RunCommandForTime(new RunCommand(() -> m_robotTurret.runShooterRotatePID((180.0 / Math.PI) * Math.atan2(-(82.83 / 2.00) + 15.56, -(219.25 / 2.00) - 40.44 + 10.00)), m_robotTurret), 1.0, true) // TODO: optimize time
new RunCommandForTime(new RunCommand(() -> m_robotTurret.runShooterRotatePID(-180), m_robotTurret), 1.0, true) // TODO: optimize time
);
}
src/main/java/frc4388/robot/subsystems/VisionOdometry.java
+1 -1
View File
@@ -45,7 +45,7 @@ public class VisionOdometry extends SubsystemBase {
public VisionOdometry(SwerveDrive drive, Turret shooter) {
// do{
m_camera = new PhotonCamera(VisionConstants.NAME);
// }while(m_camera.getLatestResult().getLatencyMillis() == 0.d);
// } while (m_camera.getLatestResult().getLatencyMillis() == 0.d);
m_drive = drive;
m_shooter = shooter;