Commit | Line | Data |
---|---|---|
6bb7f8ac | 1 | package org.usfirst.frc.team3501.robot.commands.auton; |
d607dcbb | 2 | |
dfcc1b21 CZ |
3 | import org.usfirst.frc.team3501.robot.commands.driving.DriveForTime; |
4 | ||
42d6d87c | 5 | import edu.wpi.first.wpilibj.command.CommandGroup; |
d607dcbb ME |
6 | |
7 | /*** | |
8 | * This command will drive the robot through the rough terrain. | |
9 | * | |
a7c4ef67 ME |
10 | * dependency on subsytems: drivetrain |
11 | * | |
12 | * dependency on other commands: DriveForTime | |
13 | * | |
d607dcbb ME |
14 | * pre-condition: robot is flush against the ramp of the outerworks in front of |
15 | * the rough terrain | |
16 | * | |
17 | * post-condition: the robot has passed the rough terrain and is in the next | |
18 | * zone | |
19 | * | |
20 | * @author Meryem and Avi | |
21 | * | |
22 | */ | |
5322db46 | 23 | public class PassRoughTerrainDistance extends CommandGroup { |
d607dcbb | 24 | |
42d6d87c ME |
25 | // TODO: test for the time |
26 | private final double BEG_TIME = 0; | |
27 | private final double MID_TIME = 0; | |
28 | private final double END_TIME = 0; | |
54c525f6 | 29 | |
42d6d87c ME |
30 | private final double BEG_SPEED = 0; |
31 | private final double MID_SPEED = 0; | |
32 | private final double END_SPEED = 0; | |
d607dcbb | 33 | |
5322db46 | 34 | public PassRoughTerrainDistance() { |
d607dcbb | 35 | |
42d6d87c ME |
36 | addSequential(new DriveForTime(BEG_TIME, BEG_SPEED)); |
37 | addSequential(new DriveForTime(MID_TIME, MID_SPEED)); | |
38 | addSequential(new DriveForTime(END_TIME, BEG_SPEED)); | |
d607dcbb | 39 | |
d607dcbb ME |
40 | } |
41 | } |