mirror of
https://github.com/Team4388/RiseOfRidgebotics2020.git
synced 2026-06-09 00:38:00 -06:00
Paths
Co-Authored-By: Nirvan Bhalala <78400306+nbhalala27@users.noreply.github.com>
This commit is contained in:
@@ -10,6 +10,7 @@ package frc4388.robot.commands.auto;
|
||||
import edu.wpi.first.wpilibj2.command.InstantCommand;
|
||||
import edu.wpi.first.wpilibj2.command.RamseteCommand;
|
||||
import edu.wpi.first.wpilibj2.command.SequentialCommandGroup;
|
||||
import edu.wpi.first.wpilibj2.command.CommandBase;
|
||||
import frc4388.robot.RobotContainer;
|
||||
import frc4388.robot.subsystems.Drive;
|
||||
|
||||
@@ -25,7 +26,9 @@ public class BarrelStart extends SequentialCommandGroup {
|
||||
// super(new FooCommand(), new BarCommand());
|
||||
addCommands(
|
||||
paths[0],
|
||||
new InstantCommand(() -> drive.tankDriveVelocity(1, 1))
|
||||
new Wait(drive, 0.01, 1),
|
||||
new TankDriveVelocity(drive, 3, 3, 1)
|
||||
//new InstantCommand(() -> drive.tankDriveVelocity(7, 7)).withTimeout(7) //my life be like oooooo aaaaaa ooooo aaaa
|
||||
);
|
||||
|
||||
}
|
||||
|
||||
@@ -29,7 +29,15 @@ public class Bounce extends SequentialCommandGroup {
|
||||
paths[0],
|
||||
new InstantCommand(() -> drive.switchReversed(true)),
|
||||
new InstantCommand(() -> robotContainer.resetOdometry(new Pose2d())),
|
||||
paths[1]
|
||||
paths[1],
|
||||
new InstantCommand(() -> drive.switchReversed(false)),
|
||||
new InstantCommand(() -> robotContainer.resetOdometry(new Pose2d())),
|
||||
paths[2],
|
||||
new InstantCommand(() -> drive.switchReversed(true)),
|
||||
new InstantCommand(() -> robotContainer.resetOdometry(new Pose2d())),
|
||||
paths[3],
|
||||
new InstantCommand(() -> drive.switchReversed(false)),
|
||||
new InstantCommand(() -> robotContainer.resetOdometry(new Pose2d()))
|
||||
);
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user