diff --git a/quad/src/quad_app/PID.h b/quad/src/quad_app/PID.h index faf5579f090e7bfe424725ce65a762e7fa9a8e9b..9753f3ab6354a014b1f4ca1d7f8d2fe6d9726c44 100644 --- a/quad/src/quad_app/PID.h +++ b/quad/src/quad_app/PID.h @@ -39,7 +39,7 @@ #define YPOS_KP 0.55 #define YPOS_KI 0.0075 #define YPOS_KD 0.0 -#define YPOS_ALPHA 0 +#define YPOS_ALPHA 0.88 //Pitch constants @@ -58,7 +58,7 @@ #define XPOS_KP 0.55 #define XPOS_KI 0.0075 #define XPOS_KD 0.0 -#define XPOS_ALPHA 0 +#define XPOS_ALPHA 0.88 //Throttle constants diff --git a/quad/src/quad_app/control_algorithm.c b/quad/src/quad_app/control_algorithm.c index 6ac42e905a8ccc74b18503568cc90ff352f68250..55d1e249c3332c721adaf55b3c55be2c0664cd14 100644 --- a/quad/src/quad_app/control_algorithm.c +++ b/quad/src/quad_app/control_algorithm.c @@ -231,6 +231,7 @@ int control_algorithm_init(parameter_t * ps) graph_set_param_val(graph, ps->alt_pid, PID_KP, ALT_ZPOS_KP); graph_set_param_val(graph, ps->alt_pid, PID_KI, ALT_ZPOS_KI); graph_set_param_val(graph, ps->alt_pid, PID_KD, ALT_ZPOS_KD); + graph_set_param_val(graph, ps->alt_pid, PID_ALPHA, ALT_ZPOS_ALPHA); // Set PWM difference clamping limits graph_set_param_val(graph, ps->clamp_d_pwmP, BOUNDS_MIN, -PWM_DIFF_BOUNDS);