smo计算低通滤波系数用FOC_CTRL_US

Signed-off-by: huhui <huhui@sharkgulf.com>

Applications/foc/core/smo_observer.c

@@ -18,7 +18,7 @@ void smo_observer_init(float pll_bandwith, float lpf_wc, float Ksmo, float Ksta)
 	smo.pll_ki = 0.25f * SQ(smo.pll_kp);
 	smo.pll_max_rad_pers = CONFIG_MAX_MOT_RPM/30.0f * M_PI * nv_get_motor_params()->poles;
 	smo.lpf_wc = lpf_wc;
-	smo.lpf_ceof = (lpf_wc*2*M_PI/(float)FOC_PWM_FS);
+	smo.lpf_ceof = (lpf_wc*2*M_PI*FOC_CTRL_US);
 	smo.Ksmo = Ksmo;
 	smo.Ksta = Ksta;
 	smo.motor_r = nv_get_motor_params()->r;