Skip to content

Commit 206c106

Browse files
committed
fixed my pid loop
1 parent 8a7af5f commit 206c106

File tree

1 file changed

+8
-12
lines changed

1 file changed

+8
-12
lines changed

TeamCode/src/main/java/org/firstinspires/ftc/teamcode/opmode/nickpidloop.java

Lines changed: 8 additions & 12 deletions
Original file line numberDiff line numberDiff line change
@@ -28,30 +28,26 @@ public void runOpMode() throws InterruptedException {
2828
waitForStart();
2929
double error = 1.1;
3030
double power = 0;
31+
double difference = 0;
32+
double preverror = 0;
33+
3134

3235
refrence = 300;
3336
Arm.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
3437
Arm.setMode(DcMotor.RunMode.RUN_USING_ENCODER);
3538

3639
while (opModeIsActive()) {
3740

38-
while (gamepad1.b)
41+
while (gamepad1.b);
3942

43+
error = preverror + error;
44+
difference = error -preverror;
45+
preverror = error;
46+
// power = error + what?? ask brennan on monday
4047

41-
// obtaining encoder position
42-
encoderPosition = Arm.getCurrentPosition();
43-
// calculate error
44-
error = refrence - encoderPosition;
45-
power = (error/250)*.7;
46-
if(power>0.7){
47-
power = 0.7;
48-
}
49-
else if(power<-.7){
50-
power = -0.7;
5148
}
5249

5350
}
5451
}
5552

5653

57-
}

0 commit comments

Comments
 (0)