Преглед на файлове

修正adrc的reset,给定输出

Signed-off-by: huhui <huhui@sharkgulf.com>
huhui преди 3 години
родител
ревизия
297419c32e
променени са 1 файла, в които са добавени 2 реда и са изтрити 2 реда
  1. 2 2
      Applications/foc/core/adrc.c

+ 2 - 2
Applications/foc/core/adrc.c

@@ -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) {