diff --git a/include/motors_movement/drivecontroller.h b/include/motors_movement/drivecontroller.h index 280d851..64fddc9 100644 --- a/include/motors_movement/drivecontroller.h +++ b/include/motors_movement/drivecontroller.h @@ -8,19 +8,14 @@ #include "PID_v2.h" -//PID Constants +//BEST NUMBERS YET +//USE MOVING AVERAGE AND ANGLE WRAP #define KP 1.5 -#define KI 0.2 +#define KI 0 #define KD 0.1 #define KSPD 0.3 -//BEST NUMBERS YET -//USE MOVING AVERAGE AND ANGLE WRAP -// #define KP 1.5 -// #define KI 0 -// #define KD 0.1 - #define UNLOCK_THRESH 800 class DriveController{