Compare commits
1 Commits
Author | SHA1 | Date | |
---|---|---|---|
847f40970f |
@ -55,11 +55,11 @@ setMaxSubsequentTimeouts("$(NAME)", 20);
|
|||||||
setThresholdComTimeout("$(NAME)", 100, 1);
|
setThresholdComTimeout("$(NAME)", 100, 1);
|
||||||
|
|
||||||
# Parametrize the EPICS record database with the substitution file named after the MCU.
|
# Parametrize the EPICS record database with the substitution file named after the MCU.
|
||||||
epicsEnvSet("SINQDBPATH","$(masterMacs_DB)/sinqMotor.db")
|
epicsEnvSet("SINQDBPATH","$(sinqMotor_DB)/sinqMotor.db")
|
||||||
dbLoadTemplate("$(TOP)/$(NAME).substitutions", "INSTR=$(INSTR)$(NAME):,CONTROLLER=$(NAME)")
|
dbLoadTemplate("$(TOP)/$(NAME).substitutions", "INSTR=$(INSTR)$(NAME):,CONTROLLER=$(NAME)")
|
||||||
epicsEnvSet("SINQDBPATH","$(masterMacs_DB)/masterMacs.db")
|
epicsEnvSet("SINQDBPATH","$(masterMacs_DB)/masterMacs.db")
|
||||||
dbLoadTemplate("$(TOP)/$(NAME).substitutions", "INSTR=$(INSTR)$(NAME):,CONTROLLER=$(NAME)")
|
dbLoadTemplate("$(TOP)/$(NAME).substitutions", "INSTR=$(INSTR)$(NAME):,CONTROLLER=$(NAME)")
|
||||||
dbLoadRecords("$(masterMacs_DB)/asynRecord.db","P=$(INSTR)$(NAME),PORT=$(ASYN_PORT)")
|
dbLoadRecords("$(sinqMotor_DB)/asynRecord.db","P=$(INSTR)$(NAME),PORT=$(ASYN_PORT)")
|
||||||
```
|
```
|
||||||
|
|
||||||
### Versioning
|
### Versioning
|
||||||
|
Submodule sinqMotor updated: 55a9fe6f3e...c2eca33ce8
@ -363,8 +363,14 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
}
|
}
|
||||||
|
|
||||||
if (timedOut) {
|
if (timedOut) {
|
||||||
setAxisParamChecked(this, motorMessageText,
|
pl_status =
|
||||||
"Timed out while waiting for a handshake");
|
setStringParam(pC_->motorMessageText(),
|
||||||
|
"Timed out while waiting for a handshake");
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorMessageText_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
pC_->read(axisNo_, 86, response);
|
pC_->read(axisNo_, 86, response);
|
||||||
@ -388,15 +394,32 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
// poll. This is already part of the movement procedure.
|
// poll. This is already part of the movement procedure.
|
||||||
*moving = true;
|
*moving = true;
|
||||||
|
|
||||||
setAxisParamChecked(this, motorStatusMoving, *moving);
|
pl_status = setIntegerParam(pC_->motorStatusMoving(), *moving);
|
||||||
setAxisParamChecked(this, motorStatusDone, !(*moving));
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status,
|
||||||
|
"motorStatusMoving_", axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
|
pl_status = setIntegerParam(pC_->motorStatusDone(), !(*moving));
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorStatusDone_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
return asynSuccess;
|
return asynSuccess;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Motor resolution from parameter library
|
// Motor resolution from parameter library
|
||||||
getAxisParamChecked(this, motorRecResolution, &motorRecResolution);
|
pl_status = pC_->getDoubleParam(axisNo_, pC_->motorRecResolution(),
|
||||||
|
&motorRecResolution);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorRecResolution_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
// Read the previous motor position
|
// Read the previous motor position
|
||||||
pl_status = motorPosition(&previousPosition);
|
pl_status = motorPosition(&previousPosition);
|
||||||
@ -460,9 +483,15 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
pC_->getMsgPrintControl().getSuffix());
|
pC_->getMsgPrintControl().getSuffix());
|
||||||
}
|
}
|
||||||
|
|
||||||
setAxisParamChecked(this, motorMessageText,
|
pl_status =
|
||||||
"Communication error between PC and motor "
|
setStringParam(pC_->motorMessageText(),
|
||||||
"controller. Please call the support.");
|
"Communication error between PC and motor "
|
||||||
|
"controller. Please call the support.");
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorMessageText_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
poll_status = asynError;
|
poll_status = asynError;
|
||||||
} else {
|
} else {
|
||||||
@ -614,7 +643,12 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
setAxisParamChecked(this, motorMessageText, errorMessage);
|
pl_status = setStringParam(pC_->motorMessageText(), errorMessage);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorMessageText_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
pC_->getMsgPrintControl().resetCount(keyError, pC_->pasynUser());
|
pC_->getMsgPrintControl().resetCount(keyError, pC_->pasynUser());
|
||||||
@ -655,18 +689,40 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
directly, but need to shrink them a bit. In this case, we're shrinking
|
directly, but need to shrink them a bit. In this case, we're shrinking
|
||||||
them by 0.1 mm or 0.1 degree (depending on the axis type) on both sides.
|
them by 0.1 mm or 0.1 degree (depending on the axis type) on both sides.
|
||||||
*/
|
*/
|
||||||
getAxisParamChecked(this, motorLimitsOffset, &limitsOffset);
|
pl_status = pC_->getDoubleParam(axisNo_, pC_->motorLimitsOffset(),
|
||||||
|
&limitsOffset);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorLimitsOffset_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
highLimit = highLimit - limitsOffset;
|
highLimit = highLimit - limitsOffset;
|
||||||
lowLimit = lowLimit + limitsOffset;
|
lowLimit = lowLimit + limitsOffset;
|
||||||
|
|
||||||
setAxisParamChecked(this, motorHighLimitFromDriver, highLimit);
|
pl_status = pC_->setDoubleParam(
|
||||||
setAxisParamChecked(this, motorLowLimitFromDriver, lowLimit);
|
axisNo_, pC_->motorHighLimitFromDriver(), highLimit);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(
|
||||||
|
pl_status, "motorHighLimitFromDriver_", axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
|
pl_status = pC_->setDoubleParam(axisNo_, pC_->motorLowLimitFromDriver(),
|
||||||
|
lowLimit);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorLowLimit_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Update the enable PV
|
// Update the enable PV
|
||||||
setAxisParamChecked(this, motorEnableRBV,
|
pl_status = setIntegerParam(pC_->motorEnableRBV(),
|
||||||
readyToBeSwitchedOn() && switchedOn());
|
readyToBeSwitchedOn() && switchedOn());
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorEnableRBV_", axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
if (*moving) {
|
if (*moving) {
|
||||||
// If the axis is moving, evaluate the movement direction
|
// If the axis is moving, evaluate the movement direction
|
||||||
@ -679,11 +735,32 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
|
|
||||||
// Update the parameter library
|
// Update the parameter library
|
||||||
if (hasError) {
|
if (hasError) {
|
||||||
setAxisParamChecked(this, motorStatusProblem, true);
|
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorStatusProblem_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
pl_status = setIntegerParam(pC_->motorStatusMoving(), *moving);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorStatusMoving_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
|
pl_status = setIntegerParam(pC_->motorStatusDone(), !(*moving));
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorStatusDone_", axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
|
pl_status = setIntegerParam(pC_->motorStatusDirection(), direction);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorStatusDirection_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
}
|
}
|
||||||
setAxisParamChecked(this, motorStatusMoving, *moving);
|
|
||||||
setAxisParamChecked(this, motorStatusDone, !(*moving));
|
|
||||||
setAxisParamChecked(this, motorStatusDirection, direction);
|
|
||||||
|
|
||||||
pl_status = setMotorPosition(currentPosition);
|
pl_status = setMotorPosition(currentPosition);
|
||||||
if (pl_status != asynSuccess) {
|
if (pl_status != asynSuccess) {
|
||||||
@ -698,7 +775,10 @@ asynStatus masterMacsAxis::doMove(double position, int relative,
|
|||||||
double acceleration) {
|
double acceleration) {
|
||||||
|
|
||||||
// Status of read-write-operations of ASCII commands to the controller
|
// Status of read-write-operations of ASCII commands to the controller
|
||||||
asynStatus status = asynSuccess;
|
asynStatus rw_status = asynSuccess;
|
||||||
|
|
||||||
|
// Status of parameter library operations
|
||||||
|
asynStatus pl_status = asynSuccess;
|
||||||
|
|
||||||
char value[pC_->MAXBUF_];
|
char value[pC_->MAXBUF_];
|
||||||
double motorCoordinatesPosition = 0.0;
|
double motorCoordinatesPosition = 0.0;
|
||||||
@ -709,8 +789,19 @@ asynStatus masterMacsAxis::doMove(double position, int relative,
|
|||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
getAxisParamChecked(this, motorEnableRBV, &enabled);
|
pl_status = pC_->getIntegerParam(axisNo_, pC_->motorEnableRBV(), &enabled);
|
||||||
getAxisParamChecked(this, motorRecResolution, &motorRecResolution);
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "enableMotorRBV_", axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
|
pl_status = pC_->getDoubleParam(axisNo_, pC_->motorRecResolution(),
|
||||||
|
&motorRecResolution);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorRecResolution_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
if (enabled == 0) {
|
if (enabled == 0) {
|
||||||
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
@ -730,13 +821,24 @@ asynStatus masterMacsAxis::doMove(double position, int relative,
|
|||||||
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, position);
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, position);
|
||||||
|
|
||||||
// Check if the speed is allowed to be changed
|
// Check if the speed is allowed to be changed
|
||||||
getAxisParamChecked(this, motorCanSetSpeed, &motorCanSetSpeed);
|
pl_status = pC_->getIntegerParam(axisNo_, pC_->motorCanSetSpeed(),
|
||||||
|
&motorCanSetSpeed);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorCanSetSpeed_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
// Initialize the movement handshake
|
// Initialize the movement handshake
|
||||||
status = pC_->write(axisNo_, 86, "0");
|
rw_status = pC_->write(axisNo_, 86, "0");
|
||||||
if (status != asynSuccess) {
|
if (rw_status != asynSuccess) {
|
||||||
setAxisParamChecked(this, motorStatusProblem, true);
|
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
||||||
return status;
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorStatusProblem_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
return rw_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Set the new motor speed, if the user is allowed to do so and if the
|
// Set the new motor speed, if the user is allowed to do so and if the
|
||||||
@ -746,10 +848,15 @@ asynStatus masterMacsAxis::doMove(double position, int relative,
|
|||||||
pMasterMacsA_->lastSetSpeed = motorVelocity;
|
pMasterMacsA_->lastSetSpeed = motorVelocity;
|
||||||
|
|
||||||
snprintf(value, sizeof(value), "%lf", motorVelocity);
|
snprintf(value, sizeof(value), "%lf", motorVelocity);
|
||||||
status = pC_->write(axisNo_, 05, value);
|
rw_status = pC_->write(axisNo_, 05, value);
|
||||||
if (status != asynSuccess) {
|
if (rw_status != asynSuccess) {
|
||||||
setAxisParamChecked(this, motorStatusProblem, true);
|
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
||||||
return status;
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status,
|
||||||
|
"motorStatusProblem_", axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
return rw_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
asynPrint(pC_->pasynUser(), ASYN_TRACE_FLOW,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_FLOW,
|
||||||
@ -761,10 +868,15 @@ asynStatus masterMacsAxis::doMove(double position, int relative,
|
|||||||
|
|
||||||
// Set the target position
|
// Set the target position
|
||||||
snprintf(value, sizeof(value), "%lf", motorCoordinatesPosition);
|
snprintf(value, sizeof(value), "%lf", motorCoordinatesPosition);
|
||||||
status = pC_->write(axisNo_, 02, value);
|
rw_status = pC_->write(axisNo_, 02, value);
|
||||||
if (status != asynSuccess) {
|
if (rw_status != asynSuccess) {
|
||||||
setAxisParamChecked(this, motorStatusProblem, true);
|
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
||||||
return status;
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorStatusProblem_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
return rw_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
// If the motor has just been enabled, use Enable
|
// If the motor has just been enabled, use Enable
|
||||||
@ -776,13 +888,18 @@ asynStatus masterMacsAxis::doMove(double position, int relative,
|
|||||||
|
|
||||||
// Start the move
|
// Start the move
|
||||||
if (relative) {
|
if (relative) {
|
||||||
status = pC_->write(axisNo_, 00, "2", timeout);
|
rw_status = pC_->write(axisNo_, 00, "2", timeout);
|
||||||
} else {
|
} else {
|
||||||
status = pC_->write(axisNo_, 00, "1", timeout);
|
rw_status = pC_->write(axisNo_, 00, "1", timeout);
|
||||||
}
|
}
|
||||||
if (status != asynSuccess) {
|
if (rw_status != asynSuccess) {
|
||||||
setAxisParamChecked(this, motorStatusProblem, true);
|
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
||||||
return status;
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorStatusProblem_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
return rw_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
// In the next poll, we will check if the handshake has been performed in a
|
// In the next poll, we will check if the handshake has been performed in a
|
||||||
@ -796,35 +913,60 @@ asynStatus masterMacsAxis::doMove(double position, int relative,
|
|||||||
return asynError;
|
return asynError;
|
||||||
}
|
}
|
||||||
|
|
||||||
return status;
|
return rw_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
asynStatus masterMacsAxis::stop(double acceleration) {
|
asynStatus masterMacsAxis::stop(double acceleration) {
|
||||||
|
|
||||||
asynStatus status = pC_->write(axisNo_, 00, "8");
|
// Status of read-write-operations of ASCII commands to the controller
|
||||||
if (status != asynSuccess) {
|
asynStatus rw_status = asynSuccess;
|
||||||
setAxisParamChecked(this, motorStatusProblem, true);
|
|
||||||
|
// Status of parameter library operations
|
||||||
|
asynStatus pl_status = asynSuccess;
|
||||||
|
|
||||||
|
// =========================================================================
|
||||||
|
|
||||||
|
rw_status = pC_->write(axisNo_, 00, "8");
|
||||||
|
if (rw_status != asynSuccess) {
|
||||||
|
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorStatusProblem_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Reset the driver to idle state and move out of the handshake wait loop,
|
// Reset the driver to idle state and move out of the handshake wait loop,
|
||||||
// if we're currently inside it.
|
// if we're currently inside it.
|
||||||
pMasterMacsA_->waitForHandshake = false;
|
pMasterMacsA_->waitForHandshake = false;
|
||||||
|
|
||||||
return status;
|
return rw_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
asynStatus masterMacsAxis::doReset() {
|
asynStatus masterMacsAxis::doReset() {
|
||||||
|
// Status of read-write-operations of ASCII commands to the controller
|
||||||
|
asynStatus rw_status = asynSuccess;
|
||||||
|
|
||||||
asynStatus status = pC_->write(axisNo_, 17, "");
|
// Status of parameter library operations
|
||||||
if (status != asynSuccess) {
|
asynStatus pl_status = asynSuccess;
|
||||||
setAxisParamChecked(this, motorStatusProblem, true);
|
|
||||||
|
// =========================================================================
|
||||||
|
|
||||||
|
rw_status = pC_->write(axisNo_, 17, "");
|
||||||
|
if (rw_status != asynSuccess) {
|
||||||
|
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorStatusProblem_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Reset the driver to idle state and move out of the handshake wait loop,
|
// Reset the driver to idle state and move out of the handshake wait loop,
|
||||||
// if we're currently inside it.
|
// if we're currently inside it.
|
||||||
pMasterMacsA_->waitForHandshake = false;
|
pMasterMacsA_->waitForHandshake = false;
|
||||||
|
|
||||||
return status;
|
return rw_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@ -833,25 +975,41 @@ Home the axis. On absolute encoder systems, this is a no-op
|
|||||||
asynStatus masterMacsAxis::doHome(double min_velocity, double max_velocity,
|
asynStatus masterMacsAxis::doHome(double min_velocity, double max_velocity,
|
||||||
double acceleration, int forwards) {
|
double acceleration, int forwards) {
|
||||||
|
|
||||||
|
// Status of read-write-operations of ASCII commands to the controller
|
||||||
|
asynStatus rw_status = asynSuccess;
|
||||||
|
|
||||||
|
// Status of parameter library operations
|
||||||
|
asynStatus pl_status = asynSuccess;
|
||||||
|
|
||||||
char response[pC_->MAXBUF_] = {0};
|
char response[pC_->MAXBUF_] = {0};
|
||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
getAxisParamChecked(this, encoderType, &response);
|
pl_status = pC_->getStringParam(axisNo_, pC_->encoderType(),
|
||||||
|
sizeof(response), response);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "encoderType_", axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
// Only send the home command if the axis has an incremental encoder
|
// Only send the home command if the axis has an incremental encoder
|
||||||
if (strcmp(response, IncrementalEncoder) == 0) {
|
if (strcmp(response, IncrementalEncoder) == 0) {
|
||||||
|
|
||||||
// Initialize the movement handshake
|
// Initialize the movement handshake
|
||||||
asynStatus status = pC_->write(axisNo_, 86, "0");
|
rw_status = pC_->write(axisNo_, 86, "0");
|
||||||
if (status != asynSuccess) {
|
if (rw_status != asynSuccess) {
|
||||||
setAxisParamChecked(this, motorStatusProblem, true);
|
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
||||||
return status;
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status,
|
||||||
|
"motorStatusProblem_", axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
return rw_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
status = pC_->write(axisNo_, 00, "9");
|
rw_status = pC_->write(axisNo_, 00, "9");
|
||||||
if (status != asynSuccess) {
|
if (rw_status != asynSuccess) {
|
||||||
return status;
|
return rw_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
// In the next poll, we will check if the handshake has been performed
|
// In the next poll, we will check if the handshake has been performed
|
||||||
@ -869,6 +1027,12 @@ Read the encoder type and update the parameter library accordingly
|
|||||||
*/
|
*/
|
||||||
asynStatus masterMacsAxis::readEncoderType() {
|
asynStatus masterMacsAxis::readEncoderType() {
|
||||||
|
|
||||||
|
// Status of read-write-operations of ASCII commands to the controller
|
||||||
|
asynStatus rw_status = asynSuccess;
|
||||||
|
|
||||||
|
// Status of parameter library operations
|
||||||
|
asynStatus pl_status = asynSuccess;
|
||||||
|
|
||||||
char command[pC_->MAXBUF_] = {0};
|
char command[pC_->MAXBUF_] = {0};
|
||||||
char response[pC_->MAXBUF_] = {0};
|
char response[pC_->MAXBUF_] = {0};
|
||||||
int nvals = 0;
|
int nvals = 0;
|
||||||
@ -877,9 +1041,9 @@ asynStatus masterMacsAxis::readEncoderType() {
|
|||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
// Check if this is an absolute encoder
|
// Check if this is an absolute encoder
|
||||||
asynStatus status = pC_->read(axisNo_, 60, response);
|
rw_status = pC_->read(axisNo_, 60, response);
|
||||||
if (status != asynSuccess) {
|
if (rw_status != asynSuccess) {
|
||||||
return status;
|
return rw_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
nvals = sscanf(response, "%d", &encoder_id);
|
nvals = sscanf(response, "%d", &encoder_id);
|
||||||
@ -895,18 +1059,28 @@ asynStatus masterMacsAxis::readEncoderType() {
|
|||||||
2=SSI (Absolute encoder with BiSS interface)
|
2=SSI (Absolute encoder with BiSS interface)
|
||||||
*/
|
*/
|
||||||
if (encoder_id == 0) {
|
if (encoder_id == 0) {
|
||||||
setAxisParamChecked(this, encoderType, IncrementalEncoder);
|
pl_status = setStringParam(pC_->encoderType(), IncrementalEncoder);
|
||||||
} else {
|
} else {
|
||||||
setAxisParamChecked(this, encoderType, AbsoluteEncoder);
|
pl_status = setStringParam(pC_->encoderType(), AbsoluteEncoder);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "encoderType_", axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
return asynSuccess;
|
return asynSuccess;
|
||||||
}
|
}
|
||||||
|
|
||||||
asynStatus masterMacsAxis::enable(bool on) {
|
asynStatus masterMacsAxis::enable(bool on) {
|
||||||
|
|
||||||
int timeout_enable_disable = 2;
|
int timeout_enable_disable = 2;
|
||||||
char msg[pC_->MAXBUF_];
|
char value[pC_->MAXBUF_];
|
||||||
|
|
||||||
|
// Status of read-write-operations of ASCII commands to the controller
|
||||||
|
asynStatus rw_status = asynSuccess;
|
||||||
|
|
||||||
|
// Status of parameter library operations
|
||||||
|
asynStatus pl_status = asynSuccess;
|
||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
@ -936,8 +1110,14 @@ asynStatus masterMacsAxis::enable(bool on) {
|
|||||||
"idle and can therefore not be disabled.\n",
|
"idle and can therefore not be disabled.\n",
|
||||||
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
|
||||||
|
|
||||||
setAxisParamChecked(this, motorMessageText,
|
pl_status =
|
||||||
"Axis cannot be disabled while it is moving.");
|
setStringParam(pC_->motorMessageText(),
|
||||||
|
"Axis cannot be disabled while it is moving.");
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorMessageText_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
return asynError;
|
return asynError;
|
||||||
}
|
}
|
||||||
@ -955,7 +1135,7 @@ asynStatus masterMacsAxis::enable(bool on) {
|
|||||||
}
|
}
|
||||||
|
|
||||||
// Enable / disable the axis if it is not moving
|
// Enable / disable the axis if it is not moving
|
||||||
snprintf(msg, sizeof(msg), "%d", on);
|
snprintf(value, sizeof(value), "%d", on);
|
||||||
asynPrint(pC_->pasynUser(), ASYN_TRACE_FLOW,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_FLOW,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\n%s axis.\n",
|
"Controller \"%s\", axis %d => %s, line %d:\n%s axis.\n",
|
||||||
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
|
||||||
@ -970,9 +1150,9 @@ asynStatus masterMacsAxis::enable(bool on) {
|
|||||||
timeout = PowerCycleTimeout;
|
timeout = PowerCycleTimeout;
|
||||||
}
|
}
|
||||||
|
|
||||||
asynStatus status = pC_->write(axisNo_, 04, msg, timeout);
|
rw_status = pC_->write(axisNo_, 04, value, timeout);
|
||||||
if (status != asynSuccess) {
|
if (rw_status != asynSuccess) {
|
||||||
return status;
|
return rw_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Query the axis status every few milliseconds until the axis has been
|
// Query the axis status every few milliseconds until the axis has been
|
||||||
@ -982,9 +1162,9 @@ asynStatus masterMacsAxis::enable(bool on) {
|
|||||||
|
|
||||||
// Read the axis status
|
// Read the axis status
|
||||||
usleep(100000);
|
usleep(100000);
|
||||||
status = readAxisStatus();
|
rw_status = readAxisStatus();
|
||||||
if (status != asynSuccess) {
|
if (rw_status != asynSuccess) {
|
||||||
return status;
|
return rw_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (switchedOn() == on) {
|
if (switchedOn() == on) {
|
||||||
@ -1004,10 +1184,14 @@ asynStatus masterMacsAxis::enable(bool on) {
|
|||||||
on ? "enable" : "disable", timeout_enable_disable);
|
on ? "enable" : "disable", timeout_enable_disable);
|
||||||
|
|
||||||
// Output message to user
|
// Output message to user
|
||||||
snprintf(msg, sizeof(msg), "Failed to %s within %d seconds",
|
snprintf(value, sizeof(value), "Failed to %s within %d seconds",
|
||||||
on ? "enable" : "disable", timeout_enable_disable);
|
on ? "enable" : "disable", timeout_enable_disable);
|
||||||
|
pl_status = setStringParam(pC_->motorMessageText(), value);
|
||||||
setAxisParamChecked(this, motorMessageText, msg);
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorMessageText_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
return asynError;
|
return asynError;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -1,9 +1,13 @@
|
|||||||
#ifndef masterMacsAXIS_H
|
#ifndef masterMacsAXIS_H
|
||||||
#define masterMacsAXIS_H
|
#define masterMacsAXIS_H
|
||||||
#include "masterMacsController.h"
|
|
||||||
#include "sinqAxis.h"
|
#include "sinqAxis.h"
|
||||||
#include <memory>
|
#include <memory>
|
||||||
|
|
||||||
|
// Forward declaration of the controller class to resolve the cyclic dependency
|
||||||
|
// between the controller and the axis .h-file. See
|
||||||
|
// https://en.cppreference.com/w/cpp/language/class.
|
||||||
|
class masterMacsController;
|
||||||
|
|
||||||
struct masterMacsAxisImpl;
|
struct masterMacsAxisImpl;
|
||||||
|
|
||||||
class masterMacsAxis : public sinqAxis {
|
class masterMacsAxis : public sinqAxis {
|
||||||
@ -118,10 +122,7 @@ class masterMacsAxis : public sinqAxis {
|
|||||||
*/
|
*/
|
||||||
void setNeedInit(bool needInit);
|
void setNeedInit(bool needInit);
|
||||||
|
|
||||||
/**
|
asynStatus readConfig();
|
||||||
* @brief Return a pointer to the axis controller
|
|
||||||
*/
|
|
||||||
virtual masterMacsController *pController() override { return pC_; };
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Read the Master MACS status with the xR10 command and store the
|
* @brief Read the Master MACS status with the xR10 command and store the
|
||||||
|
@ -136,6 +136,7 @@ asynStatus masterMacsController::writeRead(int axisNo, int tcpCmd,
|
|||||||
|
|
||||||
// Definition of local variables.
|
// Definition of local variables.
|
||||||
asynStatus status = asynSuccess;
|
asynStatus status = asynSuccess;
|
||||||
|
asynStatus pl_status = asynSuccess;
|
||||||
char fullCommand[MAXBUF_] = {0};
|
char fullCommand[MAXBUF_] = {0};
|
||||||
char fullResponse[MAXBUF_] = {0};
|
char fullResponse[MAXBUF_] = {0};
|
||||||
char drvMessageText[MAXBUF_] = {0};
|
char drvMessageText[MAXBUF_] = {0};
|
||||||
@ -254,7 +255,7 @@ asynStatus masterMacsController::writeRead(int axisNo, int tcpCmd,
|
|||||||
|
|
||||||
// Log the overall status (communication successfull or not)
|
// Log the overall status (communication successfull or not)
|
||||||
if (status == asynSuccess) {
|
if (status == asynSuccess) {
|
||||||
setAxisParamChecked(axis, motorStatusCommsError, false);
|
pl_status = axis->setIntegerParam(this->motorStatusCommsError_, 0);
|
||||||
} else {
|
} else {
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@ -273,12 +274,35 @@ asynStatus masterMacsController::writeRead(int axisNo, int tcpCmd,
|
|||||||
the user with different error messages if more than one error
|
the user with different error messages if more than one error
|
||||||
ocurred before an error-free communication
|
ocurred before an error-free communication
|
||||||
*/
|
*/
|
||||||
getAxisParamChecked(axis, motorStatusProblem, &motorStatusProblem);
|
pl_status =
|
||||||
|
getIntegerParam(axisNo, motorStatusProblem_, &motorStatusProblem);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return paramLibAccessFailed(pl_status, "motorStatusProblem", axisNo,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
if (motorStatusProblem == 0) {
|
if (motorStatusProblem == 0) {
|
||||||
setAxisParamChecked(axis, motorMessageText, drvMessageText);
|
pl_status =
|
||||||
setAxisParamChecked(axis, motorStatusProblem, true);
|
axis->setStringParam(motorMessageText(), drvMessageText);
|
||||||
setAxisParamChecked(axis, motorStatusCommsError, false);
|
if (pl_status != asynSuccess) {
|
||||||
|
return paramLibAccessFailed(pl_status, "motorMessageText",
|
||||||
|
axisNo, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
|
pl_status = axis->setIntegerParam(motorStatusProblem_, 1);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return paramLibAccessFailed(pl_status, "motorStatusProblem",
|
||||||
|
axisNo, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
|
pl_status = axis->setIntegerParam(motorStatusProblem_, 1);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return paramLibAccessFailed(pl_status, "motorStatusCommsError_",
|
||||||
|
axisNo, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -308,13 +332,12 @@ asynStatus masterMacsController::parseResponse(
|
|||||||
msgPrintControlKey parseKey =
|
msgPrintControlKey parseKey =
|
||||||
msgPrintControlKey(portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
msgPrintControlKey(portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
||||||
|
|
||||||
masterMacsAxis *axis = getMasterMacsAxis(axisNo);
|
|
||||||
if (axis == nullptr) {
|
|
||||||
return asynError;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Was the motor previously connected?
|
// Was the motor previously connected?
|
||||||
getAxisParamChecked(axis, motorConnected, &prevConnected);
|
status = getIntegerParam(axisNo, motorConnected(), &prevConnected);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return paramLibAccessFailed(status, "motorConnected", axisNo,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
// We don't use strlen here since the C string terminator 0x00
|
// We don't use strlen here since the C string terminator 0x00
|
||||||
// occurs in the middle of the char array.
|
// occurs in the middle of the char array.
|
||||||
@ -338,7 +361,16 @@ asynStatus masterMacsController::parseResponse(
|
|||||||
"connected.\n",
|
"connected.\n",
|
||||||
portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
||||||
|
|
||||||
setAxisParamChecked(axis, motorConnected, true);
|
masterMacsAxis *axis = getMasterMacsAxis(axisNo);
|
||||||
|
if (axis == nullptr) {
|
||||||
|
return asynError;
|
||||||
|
}
|
||||||
|
status = axis->setIntegerParam(motorConnected(), 1);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return paramLibAccessFailed(status, "motorConnected",
|
||||||
|
axisNo, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
status = callParamCallbacks();
|
status = callParamCallbacks();
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR,
|
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR,
|
||||||
@ -366,7 +398,16 @@ asynStatus masterMacsController::parseResponse(
|
|||||||
"disconnected.\n",
|
"disconnected.\n",
|
||||||
portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
||||||
|
|
||||||
setAxisParamChecked(axis, motorConnected, false);
|
masterMacsAxis *axis = getMasterMacsAxis(axisNo);
|
||||||
|
if (axis == nullptr) {
|
||||||
|
return asynError;
|
||||||
|
}
|
||||||
|
status = axis->setIntegerParam(motorConnected(), 0);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return paramLibAccessFailed(status, "motorConnected",
|
||||||
|
axisNo, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
status = callParamCallbacks();
|
status = callParamCallbacks();
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR,
|
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR,
|
||||||
|
@ -8,15 +8,11 @@
|
|||||||
|
|
||||||
#ifndef masterMacsController_H
|
#ifndef masterMacsController_H
|
||||||
#define masterMacsController_H
|
#define masterMacsController_H
|
||||||
|
#include "masterMacsAxis.h"
|
||||||
#include "sinqAxis.h"
|
#include "sinqAxis.h"
|
||||||
#include "sinqController.h"
|
#include "sinqController.h"
|
||||||
#include <memory>
|
#include <memory>
|
||||||
|
|
||||||
// Forward declaration of the controller class to resolve the cyclic dependency
|
|
||||||
// between the controller and the axis .h-file. See
|
|
||||||
// https://en.cppreference.com/w/cpp/language/class.
|
|
||||||
class masterMacsAxis;
|
|
||||||
|
|
||||||
struct masterMacsControllerImpl;
|
struct masterMacsControllerImpl;
|
||||||
|
|
||||||
class masterMacsController : public sinqController {
|
class masterMacsController : public sinqController {
|
||||||
|
Reference in New Issue
Block a user