diff --git a/Robotito/include/control.h b/Robotito/include/control.h index bdbce58693bc296e166d1aa2d4e81022df0ebf1e..84bceae1ffbca09839cd6fc563b5331a4e01cc5e 100644 --- a/Robotito/include/control.h +++ b/Robotito/include/control.h @@ -40,9 +40,9 @@ #define TICS_TO_RAD_S RAD_PER_TICK/OMNI_ODOM_CTRL_TIMER -#define KP 0.05 -#define KI 0.05 -#define KD 0.0 +#define KP 0.09 //0.09 +#define KI 0.020 //0.05 +#define KD 0.00 #define KF MAX_SPEED_POWER/MAX_SPEED_TICS typedef struct {