解决tcs工作问题

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

Applications/foc/core/etcs.c

@@ -35,9 +35,9 @@ void etcs_process(void) {
 	}
 	float mot_vel = PMSM_FOC_GetSpeed();
 	float f_vel = f_fvel + f_acc * (float)get_delta_ms(n_fv_ts);
-	if (!b_etcs_running && ((mot_vel + CONFIG_ENTER_TCS_THRO) >= f_vel)) {
+	if (!b_etcs_running && (mot_vel >= (f_vel + CONFIG_ENTER_TCS_THRO))) {
 		b_etcs_running = true;
-	}else if (b_etcs_running && ((mot_vel + CONFIG_EXIT_TCS_THRO) < f_vel)) {
+	}else if (b_etcs_running && (mot_vel < (f_vel + CONFIG_EXIT_TCS_THRO))) {
 		b_etcs_running = false;
 	}
 	if (b_etcs_running) {

Applications/foc/motor/motor.c

@@ -668,7 +668,7 @@ u16 mc_get_running_status2(void) {
 	data |= (motor.b_runStall?1:0) << 11; //是否堵转
 	data |= (PMSM_FOC_iDC_is_Limited()?1:0) << 12; //是否欠压限制母线电流
 	data |= (PMSM_FOC_Torque_is_Limited()?1:0) << 13; //是否高温限扭矩
-	data |= (motor.b_is96Mode?1:0) << 14; //是否高压模式
+	data |= (etcs_is_running()?1:0) << 14; //电子tcs是否正在工作
 	return data;
 }