File tree Expand file tree Collapse file tree 1 file changed +8
-12
lines changed
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/opmode Expand file tree Collapse file tree 1 file changed +8
-12
lines changed Original file line number Diff line number Diff line change @@ -28,30 +28,26 @@ public void runOpMode() throws InterruptedException {
28
28
waitForStart ();
29
29
double error = 1.1 ;
30
30
double power = 0 ;
31
+ double difference = 0 ;
32
+ double preverror = 0 ;
33
+
31
34
32
35
refrence = 300 ;
33
36
Arm .setMode (DcMotor .RunMode .STOP_AND_RESET_ENCODER );
34
37
Arm .setMode (DcMotor .RunMode .RUN_USING_ENCODER );
35
38
36
39
while (opModeIsActive ()) {
37
40
38
- while (gamepad1 .b )
41
+ while (gamepad1 .b );
39
42
43
+ error = preverror + error ;
44
+ difference = error -preverror ;
45
+ preverror = error ;
46
+ // power = error + what?? ask brennan on monday
40
47
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 ;
51
48
}
52
49
53
50
}
54
51
}
55
52
56
53
57
- }
You can’t perform that action at this time.
0 commit comments