ACwing FC firmware
STM32WB55: attitude IEKF, altitude Kalman filter, flight core, protocol v2
Loading...
Searching...
No Matches
alt_ctrl.h
Go to the documentation of this file.
1
11#ifndef ALT_CTRL_H
12#define ALT_CTRL_H
13
14typedef struct {
15 float hover;
16 float kp_h, kp_v, ki_v;
17 float thr_min, thr_max;
18 float i_lim;
19 float integ;
21
22void alt_ctrl_init(alt_ctrl_t *c, float hover);
23void alt_ctrl_reset(alt_ctrl_t *c, float integ);
24float alt_ctrl_vz_sp(const alt_ctrl_t *c, float h_sp, float h, float vz_up, float vz_dn);
25float alt_ctrl_step(alt_ctrl_t *c, float vz_sp, float vz, float cos_tilt, float dt);
26
27#endif /* ALT_CTRL_H */
float alt_ctrl_vz_sp(const alt_ctrl_t *c, float h_sp, float h, float vz_up, float vz_dn)
Definition alt_ctrl.c:19
void alt_ctrl_reset(alt_ctrl_t *c, float integ)
Definition alt_ctrl.c:17
void alt_ctrl_init(alt_ctrl_t *c, float hover)
Definition alt_ctrl.c:8
float alt_ctrl_step(alt_ctrl_t *c, float vz_sp, float vz, float cos_tilt, float dt)
Definition alt_ctrl.c:24
float ki_v
Definition alt_ctrl.h:16
float thr_max
Definition alt_ctrl.h:17
float integ
Definition alt_ctrl.h:19
float hover
initial hover thrust guess (0..1)
Definition alt_ctrl.h:15
float i_lim
Definition alt_ctrl.h:18