not working yet
Dependencies: Motor_with_encoder MODSERIAL mbed HIDScope
Diff: main.cpp
- Revision:
- 19:8746a2c663f8
- Parent:
- 18:5c4e27db4d9e
--- a/main.cpp Wed Nov 01 15:31:09 2017 +0000 +++ b/main.cpp Wed Nov 01 15:39:46 2017 +0000 @@ -80,7 +80,7 @@ //pc.printf("pos: %d, speed %f reference position = %.2f\r ",motor1.getPosition(), motor1.getSpeed(), setpoint); //motorpid = PID(potvalue - position, M1_KP, M1_KI, M1_KD, M1_TS, m1_err_int, m1_prev_err, m1_f_v1, m1_f_v2, M1_F_A1, M1_F_A2, M1_F_B0, M1_F_B1, M1_F_B2); - + error1 = setpoint - angle; error2 = setpoint2 - angle2;