climber subsystem 3.0

This commit is contained in:
aarav18
2022-03-20 18:09:16 -06:00
parent 7f1061ab9a
commit 70e681c7d7
5 changed files with 133 additions and 538 deletions
@@ -106,8 +106,8 @@ public class Shoot extends CommandBase {
* Updates error for custom PID.
*/
public void updateError() {
targetAngle = AimToCenter.aaravAngleToCenter(odoX, odoY, swerve.getRegGyro().getDegrees());
// targetAngle = AimToCenter.aaravAngleToCenter(odoX, odoY, swerve.getRegGyro().getDegrees());
targetAngle = 0;
error = (targetAngle - turret.getBoomBoomAngleDegrees()) % 360;
// if (error > 180) {
// error = 360 - error; // TODO: error - 360