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 3a1ab4675a94b2703094e35e9be227508269a5ae..79cf313f62c650e3bb6379ab52997f86dfeb9a48 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);