|
|
@@ -30,8 +30,8 @@ float ladrc_run(ladrc_t *adrc, float in, float feedback) {
|
|
|
|
|
|
void ladrc_reset(ladrc_t* adrc, float feedback, float out_init) {
|
|
|
adrc->last_z1 = feedback;
|
|
|
- adrc->last_z2 = -out_init;
|
|
|
- adrc->out = adrc->last_z2/adrc->b0;
|
|
|
+ adrc->last_z2 = -out_init * adrc->b0;
|
|
|
+ adrc->out = adrc->last_z2;
|
|
|
}
|
|
|
|
|
|
void ladrc_copy(ladrc_t *dst, ladrc_t *src) {
|