Fixed robot class

FIRSTTeam6423 · Feb 15, 2025 · e7eb40f · e7eb40f
1 parent 28a6a1e
commit e7eb40f
Showing 1 changed file with 5 additions and 10 deletions.
diff --git a/src/main/java/org/frc6423/frc2025/Robot.java b/src/main/java/org/frc6423/frc2025/Robot.java
@@ -66,17 +66,12 @@ public Robot() {
     m_swerveSubsystem = new SwerveSubsystem(new CompBotSwerveConfigs());
     m_elevatorSubsystem = new ElevatorSubsystem();
 
-    m_elevatorSubsystem.setDefaultCommand(
-        m_elevatorSubsystem.runPoseSetpoint(
-            m_driveController.getLeftY()
-                * ElevatorSubsystem.kRangeMeters)); // elevator test command
-
     // Default Commands
-    // m_swerveSubsystem.setDefaultCommand(
-    //     m_swerveSubsystem.teleopSwerveCommmand(
-    //         ControllerUtil.applyDeadband(m_driveController::getLeftY, false),
-    //         ControllerUtil.applyDeadband(m_driveController::getLeftX, false),
-    //         ControllerUtil.applyDeadband(m_driveController::getRightX, false)));
+    m_swerveSubsystem.setDefaultCommand(
+        m_swerveSubsystem.teleopSwerveCommmand(
+            ControllerUtil.applyDeadband(m_driveController::getLeftY, false),
+            ControllerUtil.applyDeadband(m_driveController::getLeftX, false),
+            ControllerUtil.applyDeadband(m_driveController::getRightX, false)));
   }
 
   @Override