From e7eb40f8ec9c78b175ab79bf1f75b0b6dd924a30 Mon Sep 17 00:00:00 2001
From: "Dasun L. Abeykoon" <Dasun20202020@hotmail.com>
Date: Fri, 14 Feb 2025 20:37:02 -0800
Subject: [PATCH] Fixed robot class

---
 src/main/java/org/frc6423/frc2025/Robot.java | 15 +++++----------
 1 file changed, 5 insertions(+), 10 deletions(-)

diff --git a/src/main/java/org/frc6423/frc2025/Robot.java b/src/main/java/org/frc6423/frc2025/Robot.java
index 2f975a4..36c2caa 100644
--- 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