|
@@ -107,7 +107,7 @@ void PositionControlTask (void* argument) {
|
|
|
}
|
|
|
} else if (queueSatus == osErrorTimeout) {
|
|
|
if (osMutexAcquire (sensorsInfoMutex, osWaitForever) == osOK) {
|
|
|
- if ((*posCtrlTaskArg->motorStatus != 0) || (movementPhase == startPhase)) {
|
|
|
+ if (((*posCtrlTaskArg->motorStatus != 0) && (movementPhase != idlePhase)) || (movementPhase == startPhase) ) {
|
|
|
if (((*posCtrlTaskArg->switchLimiterDownStat == 1) && (*posCtrlTaskArg->switchLimiterUpStat == 1)) ||
|
|
|
((*posCtrlTaskArg->switchLimiterUpStat == 1) && (*posCtrlTaskArg->switchLimiterCenterStat == 1))) {
|
|
|
movementPhase = idlePhase;
|