Skip to content

Commit

Permalink
better stopping working and DriveTurnGroup init
Browse files Browse the repository at this point in the history
  • Loading branch information
gladiatorsdriveteam1591 committed Feb 9, 2021
1 parent 75e6a06 commit d4f4733
Show file tree
Hide file tree
Showing 2 changed files with 26 additions and 1 deletion.
3 changes: 2 additions & 1 deletion Thunderclap/src/main/java/frc/robot/RobotContainer.java
Original file line number Diff line number Diff line change
Expand Up @@ -53,6 +53,7 @@

import frc.robot.commands.AutonomousCommands.DriveStraightAutonomous;
import frc.robot.commands.AutonomousCommands.GalacticSearch.ARedCommandGroup;
import frc.robot.commands.AutonomousCommands.GalacticSearch.DriveTurnGroup;
import frc.robot.commands.AutonomousCommands.GalacticSearch.OnePowerCell;
import frc.robot.commands.AutonomousCommands.Rotation.TurnToDegrees;
import frc.robot.commands.AutonomousCommands.DriveLeftAutonomous;
Expand Down Expand Up @@ -198,7 +199,7 @@ public Command getAutonomousCommand() {
// return m_driveLeftAutonomous;
// return m_driveRightAutonomous;

return new TurnToDegrees(m_driveTrain, 90, false);
return new DriveTurnGroup(m_driveTrain);
// return m_ARedCommandGroup;
}
}
Original file line number Diff line number Diff line change
@@ -0,0 +1,24 @@
package frc.robot.commands.AutonomousCommands.GalacticSearch;

import edu.wpi.first.wpilibj2.command.SequentialCommandGroup;
import frc.robot.commands.AutonomousCommands.DriveDistance.DriveInches;
import frc.robot.commands.AutonomousCommands.Rotation.TurnToDegrees;
import frc.robot.subsystems.DriveTrainC;

public class DriveTurnGroup extends SequentialCommandGroup{
public DriveTurnGroup(DriveTrainC driveTrainC) {
addCommands(
new DriveInches(driveTrainC, 45),
new TurnToDegrees(driveTrainC, 90, false)

// when I add below it won't move forward after the first move forward
// turning still works fine though
// new DriveInches(driveTrainC, 45),
// new TurnToDegrees(driveTrainC, 90, false),
// new DriveInches(driveTrainC, 45),
// new TurnToDegrees(driveTrainC, 90, false),
// new DriveInches(driveTrainC, 45),
// new TurnToDegrees(driveTrainC, 90, false)
);
}
}

0 comments on commit d4f4733

Please sign in to comment.