@@ -30,21 +30,21 @@ public AutonomousCommand(String team, String startPos, String autoMode){
30
30
{
31
31
if (team == "red" )
32
32
{ // tested with competition robot on practice field
33
- addSequential (new AutoDrive (0.65 , 70 )); // previously "90"
34
- addSequential (new AutoDrive (52.5 ));
35
- addSequential (new VisionCorrect (true , 4 ));
36
- addSequential (new AutoDrive (0.65 , 15 ));
33
+ addSequential (new AutoDrive ( 0.6 , 90 ));
34
+ addSequential (new AutoDrive ( 52.5 ));
35
+ addSequential (new VisionCorrect ( true , 4 ));
36
+ addSequential (new AutoDrive ( 0.6 , 10 ));
37
37
}
38
38
if (team == "blue" )
39
39
{ // based on mirror of "red-right"
40
- addSequential (new AutoDrive (0.65 , 90 ));
40
+ addSequential (new AutoDrive (0.6 , 90 ));
41
41
addSequential (new AutoDrive (52.5 ));
42
42
addSequential (new VisionCorrect (true , 4 ));
43
- addSequential (new AutoDrive (0.65 , 15 ));
43
+ addSequential (new AutoDrive (0.6 , 10 ));
44
44
}
45
45
addSequential (new SetClawPosition (true ));
46
46
addSequential (new PushGear (true ));
47
- addSequential (new Wait (0.5 ));
47
+ addSequential (new Wait (0.6 ));
48
48
addSequential (new AutoDrive (-0.7 , 20 ));
49
49
addSequential (new PushGear (false ));
50
50
addSequential (new Wait (0.1 ));
@@ -62,16 +62,16 @@ public AutonomousCommand(String team, String startPos, String autoMode){
62
62
}
63
63
if (startPos == "middle" )
64
64
{ // tested with competition robot on practice field
65
- addSequential (new AutoDrive (0.65 , 40 ));
65
+ addSequential (new AutoDrive (0.6 , 40 ));
66
66
addSequential (new VisionCorrect (true , 4 ));
67
- addSequential (new AutoDrive (0.65 , 20 ));
67
+ addSequential (new AutoDrive (0.6 , 20 ));
68
68
addSequential (new SetClawPosition (true ));
69
69
addSequential (new PushGear (true ));
70
- addSequential (new Wait (0.5 ));
70
+ addSequential (new Wait (0.6 ));
71
71
addSequential (new PushGear (false ));
72
72
addSequential (new Wait (0.1 ));
73
73
addSequential (new PushGear (true ));
74
- addSequential (new Wait (0.5 ));
74
+ addSequential (new Wait (0.6 ));
75
75
addSequential (new AutoDrive (-0.7 , 15 ));
76
76
addSequential (new PushGear (false ));
77
77
addSequential (new Wait (0.1 ));
@@ -81,25 +81,25 @@ public AutonomousCommand(String team, String startPos, String autoMode){
81
81
{
82
82
if (team == "red" )
83
83
{ // tested with competition robot on practice field
84
- addSequential (new AutoDrive (0.65 , 89 ));
84
+ addSequential (new AutoDrive (0.6 , 89 ));
85
85
addSequential (new AutoDrive (-52.5 ));
86
86
addSequential (new VisionCorrect (true , 4 ));
87
- addSequential (new AutoDrive (0.65 , 30 ));
87
+ addSequential (new AutoDrive (0.6 , 25 ));
88
88
}
89
89
if (team == "blue" )
90
90
{ // based on mirror of "red left"
91
- addSequential (new AutoDrive (0.65 , 89 ));
91
+ addSequential (new AutoDrive (0.6 , 89 ));
92
92
addSequential (new AutoDrive (-52.5 ));
93
93
addSequential (new VisionCorrect (true , 4 ));
94
- addSequential (new AutoDrive (0.65 , 30 ));
94
+ addSequential (new AutoDrive (0.6 , 25 ));
95
95
}
96
96
addSequential (new SetClawPosition (true ));
97
97
addSequential (new PushGear (true ));
98
- addSequential (new Wait (0.5 ));
98
+ addSequential (new Wait (0.6 ));
99
99
addSequential (new PushGear (false ));
100
100
addSequential (new Wait (0.1 ));
101
101
addSequential (new PushGear (true ));
102
- addSequential (new Wait (0.5 ));
102
+ addSequential (new Wait (0.6 ));
103
103
addSequential (new AutoDrive (-0.7 , 20 ));
104
104
addSequential (new PushGear (false ));
105
105
addSequential (new Wait (0.1 ));
0 commit comments