|
@@ -97,7 +97,7 @@ static u16 _motor_limit(void) {
|
|
|
if (lim_value != HW_LIMIT_NONE) {
|
|
if (lim_value != HW_LIMIT_NONE) {
|
|
|
if (lim_value == 0) {
|
|
if (lim_value == 0) {
|
|
|
if (mc_set_critical_error(FOC_CRIT_MOTOR_TEMP_Err)) {
|
|
if (mc_set_critical_error(FOC_CRIT_MOTOR_TEMP_Err)) {
|
|
|
- mc_crit_err_add_s16(FOC_CRIT_MOTOR_TEMP_Err, temp);
|
|
|
|
|
|
|
+ mc_crit_err_add(FOC_CRIT_MOTOR_TEMP_Err, temp, (s16)PMSM_FOC_GetSpeed());
|
|
|
}
|
|
}
|
|
|
}else if (_can_recovery){
|
|
}else if (_can_recovery){
|
|
|
mc_clr_critical_error(FOC_CRIT_MOTOR_TEMP_Err);
|
|
mc_clr_critical_error(FOC_CRIT_MOTOR_TEMP_Err);
|
|
@@ -139,7 +139,7 @@ static u16 _mos_limit(void) {
|
|
|
if (lim_value != HW_LIMIT_NONE) {
|
|
if (lim_value != HW_LIMIT_NONE) {
|
|
|
if (lim_value == 0) {
|
|
if (lim_value == 0) {
|
|
|
if (mc_set_critical_error(FOC_CRIT_MOS_TEMP_Err)) {
|
|
if (mc_set_critical_error(FOC_CRIT_MOS_TEMP_Err)) {
|
|
|
- mc_crit_err_add_s16(FOC_CRIT_MOS_TEMP_Err, temp);
|
|
|
|
|
|
|
+ mc_crit_err_add(FOC_CRIT_MOS_TEMP_Err, temp, (s16)PMSM_FOC_GetSpeed());
|
|
|
}
|
|
}
|
|
|
}else if (_can_recovery){
|
|
}else if (_can_recovery){
|
|
|
mc_clr_critical_error(FOC_CRIT_MOS_TEMP_Err);
|
|
mc_clr_critical_error(FOC_CRIT_MOS_TEMP_Err);
|
|
@@ -204,7 +204,7 @@ u16 vbus_under_vol_limit(void) {
|
|
|
if (lim_value != HW_LIMIT_NONE) {
|
|
if (lim_value != HW_LIMIT_NONE) {
|
|
|
if (mc_set_critical_error(FOC_CRIT_UN_Vol_Err)) {
|
|
if (mc_set_critical_error(FOC_CRIT_UN_Vol_Err)) {
|
|
|
if (PMSM_FOC_GetSpeed() > CONFIG_ZERO_SPEED_RPM) {
|
|
if (PMSM_FOC_GetSpeed() > CONFIG_ZERO_SPEED_RPM) {
|
|
|
- mc_crit_err_add_s16(FOC_CRIT_UN_Vol_Err, vol);
|
|
|
|
|
|
|
+ mc_crit_err_add(FOC_CRIT_UN_Vol_Err, vol, (s16)PMSM_FOC_GetSpeed());
|
|
|
}
|
|
}
|
|
|
}
|
|
}
|
|
|
return lim_value;
|
|
return lim_value;
|