autonomous tweak

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

@@ -43,7 +43,7 @@ public class RobotContainer {
   private final BalanceCommand m_BalanceCommand = new BalanceCommand(m_PID, m_Tank);
   private final AutoCommand m_AutoCommand = new AutoCommand(m_PID, m_Tank, m_claw, m_Arm);
   private final PlaceConeSecondLevelCommand m_PlaceConeSecondLevelCommand =
-      new PlaceConeSecondLevelCommand(m_Tank, m_Arm);
+      new PlaceConeSecondLevelCommand(m_Tank, m_Arm, m_claw);
   private final IncreaseMaxSpeedCommand m_IncreaseMaxSpeedCommand =
       new IncreaseMaxSpeedCommand(m_Tank);
   private final DecreaseMaxSpeedCommand m_DecreaseMaxSpeedCommand =

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

@@ -9,7 +9,7 @@
 
 public class AutoCommand extends SequentialCommandGroup {
   public AutoCommand(PID m_pid, Tank m_driveBase, Claw m_claw, Arm m_arm) {
-    addCommands(new PlaceConeSecondLevelCommand(m_driveBase, m_arm));
+    addCommands(new PlaceConeSecondLevelCommand(m_driveBase, m_arm, m_claw));
 
     // new BalanceCommand(m_pid, m_driveBase);
     // new PlaceCubeFirstLevelCommand(m_driveBase, m_claw, m_arm)

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

@@ -10,14 +10,15 @@
 public class PlaceConeSecondLevelCommand extends CommandBase {
   @SuppressWarnings({"PMD.UnusedPrivateField", "PMD.SingularField"})
   private final Tank drive;
-
+  private final Claw claw;
   private final Arm arm;
 
   private boolean firstStep = true;
 
-  public PlaceConeSecondLevelCommand(Tank drive, Arm arm) {
+  public PlaceConeSecondLevelCommand(Tank drive, Arm arm, Claw claw) {
     this.drive = drive;
     this.arm = arm;
+    this.claw = claw;
     addRequirements(drive);
     addRequirements(arm);
   }
@@ -37,6 +38,7 @@ public void initialize() {
   public void execute() {
     if (firstStep) {
       if (Math.abs(arm.armMotor.getEncoder().getPosition()) < 105) {
+        claw.closeClaw();
         arm.armMotor.set(0.4);
       }
 
@@ -48,6 +50,7 @@ public void execute() {
 
       // go over charge station
       if (Math.abs(drive.getAverageDistance()) < 4.6 && firstStep == false) {
+        claw.stopClaw(); 
         drive.setAllMotors(-0.3); // move back so that cone falls in
         arm.armMotor.set(-0.45);
       }