-
Notifications
You must be signed in to change notification settings - Fork 0
/
AutoConstants.java
151 lines (120 loc) · 3.88 KB
/
AutoConstants.java
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
package com.team2169.robot.auto;
public class AutoConstants {
public enum AutoSequenceMode{
NORMAL, DRIVE_FORWARD, NOTHING, SELF_TEST
}
public enum ElementSide {
LEFT, RIGHT, ERROR
}
public static enum Preference {
SWITCH, SCALE
}
public static enum Yield {
NONE, FAR_SCALE, ALL_SCALE
}
public enum RobotSide {
LEFT, RIGHT, CENTER, ERROR
}
public enum CenterPriority {
ONE_BLOCK, TWO_BLOCK
}
public enum SidePriority {
ONE_SCALE, TWO_SCALE, SWITCH_SCALE_ONE_BLOCK, SWITCH_SCALE_TWO_BLOCK
}
public enum Possesion {
CLOSE, FAR, CENTER, ERROR
}
// Left Side Default
public static class SideAutos {
public static class OneBlockAutos {
public static class CloseSwitch {
public static double startToPoint = 156;
public static double pointToSwitchTurn = 90;
public static double pointToSwitch = 18;
public static double intakeSpeed = .75;
}
public static class FarSwitch{
public static double startToPoint = 210;
public static double pointToPoint2Turn = 90;
public static double pointToPoint2 = 236;
public static double point2ToSwitchTurn = 120;
public static double point2ToSwitch= 36;
public static double intakeSpeed = .3;
public static double intakeInSpeed = .5;
}
public static class CloseScale {
public static double startToPoint = 256;
public static double pointToScaleTurn = 50;
public static double pointToScale = 24;
public static double intakeSpeed = .5;
public static double intakeInSpeed = .5;
public static class ScaleSwitchClose {
public static double blockToSwitch = 6;
}
}
public static class FarScale {
public static double startToPoint = 215;
public static double pointToPoint2Turn = 90;
public static double pointToPoint2 = 236;
public static double point2ToScaleTurn = -110;
public static double point2ToScale = 62;
public static double intakeSpeed = .4;
public static double intakeInSpeed = .5;
}
}
public static class TwoBlockAutos {
public static class Close {
public static double startToPoint = 256;
public static double pointToScaleTurn = 50;
public static double pointToScale = 17;
public static double pointToBlockTurn = 100;
public static double pointToBlock = 61;
public static double intakeSpeed = .7;
public static double intakeInSpeed = 1;
public static class ScaleSwitchClose {
public static double blockToSwitch = 6;
}
}
public static class Far {
public static double startToPoint = 215;
public static double pointToPoint2Turn = 90;
public static double pointToPoint2 = 236;
public static double point2ToScaleTurn = -95;
public static double point2ToScale = 62;
public static double point2ToPoint3 = -18;
public static double point3ToBlockTurn = -120;
public static double point3ToBlock = 48;
public static double intakeSpeed = .3;
public static double intakeInSpeed = .5;
public static class ScaleSwitchFar {
public static double BlockToSwitch = 6;
}
}
}
}
public static class CenterAutos {
// Left Switch
public static class OneBlock {
public static double intakeSpeed = .5;
public static double intakeInSpeed = .5;
public static class Right{
public static double startToPoint = 27;
public static double pointToSwitchTurn = -55;
public static double pointToPoint2 = 50;
public static double pointToSwitch = 35;
}
public static class Left{
public static double startToPoint = 27;
public static double pointToSwitchTurn = 55;
public static double pointToPoint2 = 70;
public static double pointToSwitch = 30;
}
}
public static class TwoBlock {
public static double switchToPoint = -70;
public static double pointToPileTurn = 35;
public static double pointToPile = 52;
}
}
public static final double driveForwardDistance = 100;
}