mirror of
https://github.com/Binary-Coalescence/motorDSM.git
synced 2025-08-04 21:55:40 -05:00
Set problem and limit flags when md90 error status returned.
This commit is contained in:
@@ -298,20 +298,31 @@ asynStatus MD90Axis::poll(bool *moving)
|
|||||||
case 3: // Move stopped
|
case 3: // Move stopped
|
||||||
break;
|
break;
|
||||||
case 4: // Homing error
|
case 4: // Homing error
|
||||||
|
setIntegerParam(pC_->motorStatusProblem_, 1);
|
||||||
break;
|
break;
|
||||||
case 5: // Stance error
|
case 5: // Stance error
|
||||||
|
setIntegerParam(pC_->motorStatusProblem_, 1);
|
||||||
break;
|
break;
|
||||||
case 6: // Stance complete
|
case 6: // Stance complete
|
||||||
break;
|
break;
|
||||||
case 7: // Open loop move error
|
case 7: // Open loop move error
|
||||||
|
setIntegerParam(pC_->motorStatusProblem_, 1);
|
||||||
break;
|
break;
|
||||||
case 8: // Closed loop move error
|
case 8: // Closed loop move error
|
||||||
|
setIntegerParam(pC_->motorStatusProblem_, 1);
|
||||||
break;
|
break;
|
||||||
case 9: // Closed loop move complete
|
case 9: // Closed loop move complete
|
||||||
break;
|
break;
|
||||||
case 10: // End of travel error
|
case 10: // End of travel error
|
||||||
|
setIntegerParam(pC_->motorStatusProblem_, 1);
|
||||||
|
if (position > 0) {
|
||||||
|
setIntegerParam(pC_->motorStatusHighLimit_, 1);
|
||||||
|
} else {
|
||||||
|
setIntegerParam(pC_->motorStatusLowLimit_, 1);
|
||||||
|
}
|
||||||
break;
|
break;
|
||||||
case 11: // Ramp move error
|
case 11: // Ramp move error
|
||||||
|
setIntegerParam(pC_->motorStatusProblem_, 1);
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
break;
|
break;
|
||||||
|
Reference in New Issue
Block a user