Merge branch 'master' of https://git.demerso.net/pls5618/2024/betabot-2024

src/main/java/frc/robot/Constants.java

@@ -3,18 +3,15 @@ package frc.robot;
 public class Constants {
 
     //Moteur
-        public static int lanceur = 0;
+        public static int lanceur = 10;
         public static int avantdroitDrive = 17;
         public static int avantdroitAngle = 18;
-        public static int avantgaucheDrive = 0;
-        public static int avantgaucheAngle = 1;
+        public static int avantgaucheDrive = 2;
+        public static int avantgaucheAngle = 3;
         public static int arrieredroitDrive = 11;
         public static int arrieredroitAngle = 12;
         public static int arrieregaucheDrive = 8;
         public static int arrieregaucheAngle = 9;
-        public static int accumulateur = 9;
-        
-        //limit switch
-            public static int ballon = 10;
+        public static int accumulateur = 19;
 
 }           

src/main/java/frc/robot/RobotContainer.java

@@ -3,8 +3,8 @@
 // the WPILib BSD license file in the root directory of this project.
 
 package frc.robot;
+import edu.wpi.first.math.MathUtil;
 import edu.wpi.first.networktables.GenericEntry;
-import edu.wpi.first.wpilibj.Joystick;
 import edu.wpi.first.wpilibj.shuffleboard.BuiltInLayouts;
 import edu.wpi.first.wpilibj.shuffleboard.Shuffleboard;
 import edu.wpi.first.wpilibj.shuffleboard.ShuffleboardLayout;
@@ -14,7 +14,6 @@ import edu.wpi.first.wpilibj2.command.RunCommand;
 import edu.wpi.first.wpilibj2.command.SequentialCommandGroup;
 import edu.wpi.first.wpilibj2.command.button.CommandJoystick;
 import edu.wpi.first.wpilibj2.command.button.CommandXboxController;
-import edu.wpi.first.wpilibj2.command.button.JoystickButton;
 import frc.robot.commands.Avancer;
 import frc.robot.commands.Force1;
 import frc.robot.commands.Force2;
@@ -45,6 +44,7 @@ public class RobotContainer {
   GenericEntry force5 = forces.add("Force5", 0).getEntry();
   GenericEntry force6 = forces.add("Force6", 0).getEntry();
   GenericEntry force7 = forces.add("Force7", 0).getEntry();
+
   CommandXboxController manette = new CommandXboxController(0);
   CommandJoystick joystick1 = new CommandJoystick(0);
   Drive drive = new Drive();
@@ -52,7 +52,7 @@ public class RobotContainer {
     
     configureBindings();
     drive.setDefaultCommand(new RunCommand(()->{
-     drive.drive(joystick1.getX(), -joystick1.getY(), -joystick1.getZ());
+     drive.drive(-joystick1.getY(), -joystick1.getX(), MathUtil.applyDeadband(-joystick1.getZ(), 0.2));
     },drive));
   }
   

src/main/java/frc/robot/commands/Avancer.java

@@ -35,6 +35,6 @@ public class Avancer extends CommandBase {
   // Returns true when the command should end.
   @Override
   public boolean isFinished() {
-    return false;
+    return drive.distance()[0].distanceMeters>1;
   }
 }

src/main/java/frc/robot/commands/Reculer.java

@@ -33,6 +33,6 @@ public class Reculer extends CommandBase {
   // Returns true when the command should end.
   @Override
   public boolean isFinished() {
-    return false;
+    return drive.distance()[0].distanceMeters>1;
   }
 }

src/main/java/frc/robot/subsystems/Drive.java

@@ -19,7 +19,7 @@ public class Drive extends SubsystemBase {
   File swerveJsonDirectory = new File(Filesystem.getDeployDirectory(),"swerve");
  
   public void drive(double x, double y, double zRotation){
-    swerveDrive.drive(new Translation2d(x, y), zRotation, true, false);
+    swerveDrive.drive(new Translation2d(x, y), zRotation, false, false);
   }