@@ -13,7 +13,8 @@ public class CenterOnFeeder extends Command {
13
13
14
14
public enum PossiblePosses {
15
15
16
- FIRST (0 , 0 ), SECOND (0 , 0 ), THIRD (0 , 0 ), FOURTH (0 , 0 ), FIFTH (0 , 0 ), SIXTH (0 , 0 ), SEVENTH (0 , 0 );
16
+ FAR_LEFT (0 , 0 ), MIDDLE_LEFT (0 , 0 ), CLOSE_LEFT (0 , 0 ),
17
+ CENTER (0 , 0 ), CLOSE_RIGHT (0 , 0 ), MIDDLE_RIGHT (0 , 0 ), FAR_RIGHT (0 , 0 );
17
18
18
19
public final double xPose ;
19
20
public final double yPose ;
@@ -58,8 +59,8 @@ public void execute() {
58
59
yPIDController .setPID (pidSettings .getkP (), pidSettings .getkI (), pidSettings .getkD ());
59
60
yPIDController .setTolerance (pidSettings .getTolerance ());
60
61
yFeedForwardController .setGains (feedForwardSettings );
61
- double shortestDistance = getDistanceFrom (PossiblePosses .FIRST .xPose , PossiblePosses .FIRST .yPose );
62
- PossiblePosses pose = PossiblePosses .FIRST ;
62
+ double shortestDistance = getDistanceFrom (PossiblePosses .FAR_LEFT .xPose , PossiblePosses .FAR_LEFT .yPose );
63
+ PossiblePosses pose = PossiblePosses .FAR_LEFT ;
63
64
for (PossiblePosses possiblePosses : PossiblePosses .values ()) {
64
65
if (shortestDistance > getDistanceFrom (possiblePosses .xPose , possiblePosses .yPose )) {
65
66
shortestDistance = getDistanceFrom (possiblePosses .xPose , possiblePosses .yPose );
0 commit comments