Zeroing rotary encoder motor steps fix

2014-07-15 18:51:17 +10:00
parent db24e03106
commit acec319ee3
2 changed files with 4 additions and 0 deletions
--- a/site_ansto/motor_dmc2280.c
+++ b/site_ansto/motor_dmc2280.c
@@ -2648,6 +2648,7 @@ static void DMCState_MotorStart(pDMC2280Driv self, pEvtEvent event) {
          cmdStatus(self);
          self->status_valid = false;
          self->subState = 4;
+          return;
        }
        else if (self->subState == 4) { /* Status after Zero */
          int iRet;
@@ -2660,6 +2661,7 @@ static void DMCState_MotorStart(pDMC2280Driv self, pEvtEvent event) {
          set_lastMotion(self, self->currSteps, self->currCounts);
          cmdOn(self);
          self->subState = 1;
+          return;
        }
      } while (0);
      break;