reset zero heading when auto/robot code starts

FRC-Team-620 · Mar 1, 2024 · 257462c · 257462c
1 parent 526e244
commit 257462c
Showing 1 changed file with 2 additions and 0 deletions.
diff --git a/src/main/java/org/jmhsrobotics/frc2024/Robot.java b/src/main/java/org/jmhsrobotics/frc2024/Robot.java
@@ -24,6 +24,7 @@ public class Robot extends TimedRobot implements Logged {
 	@Override
 	public void robotInit() {
 		m_robotContainer = new RobotContainer();
+		m_robotContainer.getDriveSubsystem().zeroHeading();
 		setupLogs();
 	}
 
@@ -63,6 +64,7 @@ public void disabledExit() {
 
 	@Override
 	public void autonomousInit() {
+		m_robotContainer.getDriveSubsystem().zeroHeading();
 		autonomousCommand = m_robotContainer.getAutonomousCommand();
 
 		if (autonomousCommand != null) {