Skip to content

Commit d509c39

Browse files
committed
added y controllers
1 parent cf7bccf commit d509c39

File tree

1 file changed

+3
-0
lines changed

1 file changed

+3
-0
lines changed

src/main/java/frc/robot/commands/CenterOnReef.java

Lines changed: 3 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -46,6 +46,9 @@ public void execute() {
4646
xPIDController.setPID(pidSettings.getkP(), pidSettings.getkI(), pidSettings.getkD());
4747
xPIDController.setTolerance(pidSettings.getTolerance());
4848
xFeedForwardController.setGains(feedForwardSettings);
49+
yPIDController.setPID(pidSettings.getkP(), pidSettings.getkI(), pidSettings.getkD());
50+
yPIDController.setTolerance(pidSettings.getTolerance());
51+
yFeedForwardController.setGains(feedForwardSettings);
4952
// @TODO make sure this is correct
5053
double ySetpoint = side == OI.Side.LEFT ? DISTANCE_FROM_TARGET : -DISTANCE_FROM_TARGET;
5154
drivetrain.drive(xPIDController.calculate(drivetrain.getPose2d().getX(), drivetrain.getPose2d().getX()) +

0 commit comments

Comments
 (0)