加入判断3相是否连接的错误

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

Applications/foc/core/PMSM_FOC_Core.h

@@ -148,6 +148,7 @@ typedef enum {
 	FOC_CRIT_CURR_OFF_Err,
 	FOC_CRIT_H_MOS_Err,
 	FOC_CRIT_L_MOS_Err,
+	FOC_CRIT_Phase_Conn_Err,
 	FOC_CRIT_Err_Max = 32,	
 }FOC_CritiCal_Ebit_t;
 

Applications/foc/motor/motor.c

@@ -53,8 +53,10 @@ static void MC_Mos_Check_error(void) {
 	gpio_phase_u_detect(false);
 	if (abc[0] > 10 || abc[1] > 10 || abc[2] > 10) {
 		PMSM_FOC_SetCriticalError(FOC_CRIT_H_MOS_Err);
-	}else if (abc[0] < 0.01f/* || abc[1] < 0.01f || abc[2] < 0.01f*/){
+	}else if (abc[0] < 0.001f){
 		PMSM_FOC_SetCriticalError(FOC_CRIT_L_MOS_Err);
+	}else if ((abc[0] > 0.5f) && (abc[1] < 0.001f || abc[2] < 0.001f)) {
+		PMSM_FOC_SetCriticalError(FOC_CRIT_Phase_Conn_Err);
 	}
 	sys_debug("vol %f, %f, %f\n", abc[0], abc[1], abc[2]);
 }