Tweaked Trapezoidal Profile, removed assistfuelCommand from right trigger

src/main/java/frc/robot/Robot.java

@@ -20,6 +20,7 @@ import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
 import edu.wpi.first.wpilibj2.command.Command;
 import edu.wpi.first.wpilibj2.command.CommandScheduler;
 import frc.robot.Constants.IntakeConstants;
+import frc.robot.subsystems.ClimberSubsystem;
 import frc.robot.subsystems.IntakeSubsystem;
 import frc.robot.subsystems.LEDSubsystem;
 import frc.robot.subsystems.TargetingSubsystems;
@@ -37,6 +38,7 @@ public class Robot extends TimedRobot {
 
     private RobotContainer m_robotContainer;
     private LEDSubsystem m_LedSubsystem;
+    private ClimberSubsystem m_ClimberSubsystem;
 
     private Timer disabledTimer;
     private static NetworkTable table;
@@ -63,7 +65,7 @@ public class Robot extends TimedRobot {
 
         m_LedSubsystem = new LEDSubsystem();
         m_robotContainer = new RobotContainer();
-
+        m_ClimberSubsystem = new ClimberSubsystem();
         // Create a timer to disable motor brake a few seconds after disable. This will
         // let the robot stop
         // immediately when disabled, but then also let it be pushed more
@@ -134,6 +136,7 @@ public class Robot extends TimedRobot {
        // IntakeSubsystem.resetIntakeRotationEncoder();
         m_robotContainer.setMotorBrake(true);
         m_autonomousCommand = m_robotContainer.getAutonomousCommand();
+        m_ClimberSubsystem.lowerRobotCommand();
 
         // Print the selected autonomous command upon autonomous init
         System.out.println("Auto selected: " + m_autonomousCommand);
@@ -156,6 +159,7 @@ public class Robot extends TimedRobot {
 
     @Override
     public void teleopInit() {
+        m_ClimberSubsystem.lowerRobotCommand();
         // This makes sure that the autonomous stops running when
         // teleop starts running. If you want the autonomous to
         // continue until interrupted by another command, remove