Set problem and limit flags when md90 error status returned.

This commit is contained in:
2024-05-24 08:44:02 -05:00
parent 4837e8f597
commit c1ffe8b805

View File

@@ -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;