Explorar o código

修正adrc的reset,给定输出

Signed-off-by: huhui <huhui@sharkgulf.com>
huhui %!s(int64=3) %!d(string=hai) anos
pai
achega
297419c32e
Modificáronse 1 ficheiros con 2 adicións e 2 borrados
  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) {