|
|
|
|
@ -25,8 +25,8 @@ typedef struct {
|
|
|
|
|
} PID_vars;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#define PID_VARS_INIT(x) PID_vars x = {.Kp=1.0,.Ki=0.00,.Kd=0.1,.output_max=15000.0, \
|
|
|
|
|
.output_min=-15000.0,._integral_sum=0.0,._prev_err=0.0,._dt=1.0}
|
|
|
|
|
#define PID_VARS_INIT(x) PID_vars x = {.Kp=1.3,.Ki=0.00,.Kd=0.0,.output_max=20000.0, \
|
|
|
|
|
.output_min=-20000.0,._integral_sum=0.0,._prev_err=0.0,._dt=1.0}
|
|
|
|
|
|
|
|
|
|
/* Function Prototypes */
|
|
|
|
|
double pid(PID_vars *vars, double current_err);
|
|
|
|
|
|