|
|
@@ -152,7 +152,7 @@ static __INLINE void phase_curr_unbal_check(mot_contrl_t *ctrl) {
|
|
|
LowPass_Filter(ctrl->phase_curr_filted[0], foc->in.curr_abc[0], lowpass);
|
|
|
LowPass_Filter(ctrl->phase_curr_filted[1], foc->in.curr_abc[1], lowpass);
|
|
|
ctrl->phase_curr_filted[2] = -(ctrl->phase_curr_filted[0] + ctrl->phase_curr_filted[1]);
|
|
|
- if ((ctrl->angle_last == INVALID_ANGLE) || (foc->mot_vel_radusPers < 100)) {
|
|
|
+ if ((ctrl->angle_last == INVALID_ANGLE) || (foc->mot_vel_radusPers < 100) || ctrl->out_current_vec < 50) {
|
|
|
ctrl->angle_last = foc->in.mot_angle;
|
|
|
a_max = b_max = c_max = 0;
|
|
|
_unbalance_cnt = 0;
|