Compare commits
6 Commits
main
...
velocity_m
| Author | SHA1 | Date | |
|---|---|---|---|
| d90869cbca | |||
| eadce0f594 | |||
| 0e1f95a94b | |||
| b01f398533 | |||
| 56d9d20c3a | |||
| 4634609891 |
2
Makefile
2
Makefile
@@ -7,7 +7,7 @@ EPICS_VERSIONS=7.0.7
|
|||||||
ARCH_FILTER=RHEL%
|
ARCH_FILTER=RHEL%
|
||||||
|
|
||||||
# Specify the version of asynMotor we want to build against
|
# Specify the version of asynMotor we want to build against
|
||||||
motorBase_VERSION=7.3.2
|
motorBase_VERSION=7.2.2
|
||||||
|
|
||||||
# These headers allow to depend on this library for derived drivers.
|
# These headers allow to depend on this library for derived drivers.
|
||||||
HEADERS += src/masterMacsAxis.h
|
HEADERS += src/masterMacsAxis.h
|
||||||
|
|||||||
@@ -29,6 +29,8 @@ struct masterMacsAxisImpl {
|
|||||||
bool needInit = true;
|
bool needInit = true;
|
||||||
bool targetReachedUninitialized;
|
bool targetReachedUninitialized;
|
||||||
bool dynamicLimits;
|
bool dynamicLimits;
|
||||||
|
bool canPositionMove;
|
||||||
|
bool canVelocityMove;
|
||||||
moveMode lastMoveCommand;
|
moveMode lastMoveCommand;
|
||||||
};
|
};
|
||||||
|
|
||||||
@@ -100,6 +102,8 @@ masterMacsAxis::masterMacsAxis(masterMacsController *pC, int axisNo)
|
|||||||
.timeAtHandshake = 0,
|
.timeAtHandshake = 0,
|
||||||
.targetReachedUninitialized = true,
|
.targetReachedUninitialized = true,
|
||||||
.dynamicLimits = false,
|
.dynamicLimits = false,
|
||||||
|
.canPositionMove = true,
|
||||||
|
.canVelocityMove = false,
|
||||||
.lastMoveCommand = positionMode,
|
.lastMoveCommand = positionMode,
|
||||||
})) {
|
})) {
|
||||||
|
|
||||||
@@ -198,6 +202,7 @@ asynStatus masterMacsAxis::init() {
|
|||||||
double motVmax = 0.0;
|
double motVmax = 0.0;
|
||||||
double motAccel = 0.0;
|
double motAccel = 0.0;
|
||||||
int dynamicLimits = 0;
|
int dynamicLimits = 0;
|
||||||
|
int possibleModes = 0;
|
||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
@@ -311,6 +316,39 @@ asynStatus masterMacsAxis::init() {
|
|||||||
}
|
}
|
||||||
pMasterMacsA_->dynamicLimits = bool(dynamicLimits);
|
pMasterMacsA_->dynamicLimits = bool(dynamicLimits);
|
||||||
|
|
||||||
|
// Check if the motor can switch its mode
|
||||||
|
status = pC_->read(axisNo_, 31, response);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
nvals = sscanf(response, "%d", &possibleModes);
|
||||||
|
if (nvals != 1) {
|
||||||
|
return pC_->couldNotParseResponse("R31", response, axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
|
switch (possibleModes) {
|
||||||
|
case 1:
|
||||||
|
pMasterMacsA_->canPositionMove = true;
|
||||||
|
pMasterMacsA_->canVelocityMove = false;
|
||||||
|
break;
|
||||||
|
case 2:
|
||||||
|
pMasterMacsA_->canPositionMove = false;
|
||||||
|
pMasterMacsA_->canVelocityMove = true;
|
||||||
|
break;
|
||||||
|
case 3:
|
||||||
|
pMasterMacsA_->canPositionMove = true;
|
||||||
|
pMasterMacsA_->canVelocityMove = true;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
|
"Controller \"%s\", axis %d => %s, line "
|
||||||
|
"%d:\nunexpected answer %d for R31 (possible operation "
|
||||||
|
"modes). Expected one of 1, 2 or 3.\n",
|
||||||
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
|
||||||
|
possibleModes);
|
||||||
|
}
|
||||||
|
|
||||||
status = readEncoderType();
|
status = readEncoderType();
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
return status;
|
return status;
|
||||||
@@ -510,6 +548,9 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
setAxisParamChecked(this, motorEncoderPosition, currentPosition);
|
setAxisParamChecked(this, motorEncoderPosition, currentPosition);
|
||||||
|
|
||||||
if (pMasterMacsA_->lastMoveCommand == velocityMode && !speedEqualZero()) {
|
if (pMasterMacsA_->lastMoveCommand == velocityMode && !speedEqualZero()) {
|
||||||
|
|
||||||
|
// TODO: Not sure whether the RVEL field of the motor record does not
|
||||||
|
// work - has to be clarified
|
||||||
double actualVelocity = 0.0;
|
double actualVelocity = 0.0;
|
||||||
|
|
||||||
rwStatus = pC_->read(axisNo_, 14, response);
|
rwStatus = pC_->read(axisNo_, 14, response);
|
||||||
@@ -522,10 +563,8 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
__PRETTY_FUNCTION__, __LINE__);
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
}
|
}
|
||||||
|
|
||||||
// Writes the actual speed in steps per second to the paramLib. This
|
// Write the actual velocity to the paramLib (TODO: does it though?)
|
||||||
// value is then returned by the RVEL field of the motor record.
|
setAxisParamChecked(this, motorVelocity, actualVelocity);
|
||||||
setAxisParamChecked(this, motorVelocity,
|
|
||||||
actualVelocity / motorRecResolution);
|
|
||||||
|
|
||||||
// Motor is moving in velocity mode
|
// Motor is moving in velocity mode
|
||||||
*moving = true;
|
*moving = true;
|
||||||
@@ -628,52 +667,12 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
poll_status = asynError;
|
poll_status = asynError;
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
|
||||||
If the motor is homing or has been homed, ignore limit switch errors.
|
|
||||||
*/
|
|
||||||
int homing = 0;
|
|
||||||
int homed = 0;
|
|
||||||
getAxisParamChecked(this, motorStatusHome, &homing);
|
|
||||||
getAxisParamChecked(this, motorStatusHomed, &homed);
|
|
||||||
|
|
||||||
/*
|
|
||||||
Ignore limit switch errors when homing / motor has been homed or when
|
|
||||||
the motor is moving.
|
|
||||||
|
|
||||||
Background:
|
|
||||||
MasterMACS controllers move the motor outside the allowed range defined
|
|
||||||
by the "software limits" defined within the controllers because they
|
|
||||||
need to hit the physical end switch to determine the motor position. The
|
|
||||||
motor then rests close to the end switch, which might be outside the
|
|
||||||
controller-side software limits. This leads to this error, which is then
|
|
||||||
forwarded to the user even though nothing went wrong. The three checks
|
|
||||||
are here to prevent this:
|
|
||||||
- "homing": Is set at the start of a homing maneuver and removed once
|
|
||||||
the motor does not move anymore => Prevents the error from showing up
|
|
||||||
during the homing procedure
|
|
||||||
- "homed": Is set after a homing maneuver has been finished => Prevents
|
|
||||||
the error from showing up while the motor is resting idle outside the
|
|
||||||
software limits.
|
|
||||||
- "moving": Prevents the error from showing up when moving out of the
|
|
||||||
homing position.
|
|
||||||
|
|
||||||
If the motor hits the limits during normal operation, it is stopped by
|
|
||||||
the controller. Once stopped, moving is false and then the error is
|
|
||||||
shown to the user (because "homed" is not set).
|
|
||||||
|
|
||||||
Note: strictly speaking, it is not necessary to check homing because
|
|
||||||
moving would be set to true anyway. The check is here for clarity /
|
|
||||||
being explicit.
|
|
||||||
*/
|
|
||||||
if (!homing && !homed && !(*moving)) {
|
|
||||||
/*
|
/*
|
||||||
Either the software limits or the end switches of the controller
|
Either the software limits or the end switches of the controller
|
||||||
have been hit. Since the EPICS limits are derived from the software
|
have been hit. Since the EPICS limits are derived from the software
|
||||||
limits and are a little bit smaller, these error cases can only
|
limits and are a little bit smaller, these error cases can only
|
||||||
happen if either the axis has an incremental encoder which is not
|
happen if either the axis has an incremental encoder which is not
|
||||||
properly homed or if the motor moved outside the limits while homing
|
properly homed or if a bug occured.
|
||||||
(but in that case, the error is not shown, see previous
|
|
||||||
if-statement).
|
|
||||||
*/
|
*/
|
||||||
if (positiveLimitSwitch() || negativeLimitSwitch() ||
|
if (positiveLimitSwitch() || negativeLimitSwitch() ||
|
||||||
positiveSoftwareLimit() || negativeSoftwareLimit()) {
|
positiveSoftwareLimit() || negativeSoftwareLimit()) {
|
||||||
@@ -706,7 +705,6 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
|
|
||||||
poll_status = asynError;
|
poll_status = asynError;
|
||||||
}
|
}
|
||||||
}
|
|
||||||
|
|
||||||
if (overCurrent()) {
|
if (overCurrent()) {
|
||||||
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
@@ -823,6 +821,18 @@ asynStatus masterMacsAxis::moveVelocity(double minVelocity, double maxVelocity,
|
|||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
|
// Can the motor be operated in velocity mode?
|
||||||
|
if (!pMasterMacsA_->canVelocityMove) {
|
||||||
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
|
"Controller \"%s\", axis %d => %s, line %d:\nAxis cannot "
|
||||||
|
"operate in velocity mode.\n",
|
||||||
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
|
||||||
|
setAxisParamChecked(this, motorStatusProblem, true);
|
||||||
|
setAxisParamChecked(this, motorMessageText,
|
||||||
|
"cannot operate in velocity mode");
|
||||||
|
return asynError;
|
||||||
|
}
|
||||||
|
|
||||||
getAxisParamChecked(this, motorEnableRBV, &enabled);
|
getAxisParamChecked(this, motorEnableRBV, &enabled);
|
||||||
getAxisParamChecked(this, motorRecResolution, &motorRecResolution);
|
getAxisParamChecked(this, motorRecResolution, &motorRecResolution);
|
||||||
|
|
||||||
@@ -888,6 +898,18 @@ asynStatus masterMacsAxis::doMove(double position, int relative,
|
|||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
|
// Can the motor be operated in position mode?
|
||||||
|
if (!pMasterMacsA_->canPositionMove) {
|
||||||
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
|
"Controller \"%s\", axis %d => %s, line %d:\nAxis cannot "
|
||||||
|
"operate in position mode.\n",
|
||||||
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
|
||||||
|
setAxisParamChecked(this, motorStatusProblem, true);
|
||||||
|
setAxisParamChecked(this, motorMessageText,
|
||||||
|
"cannot operate in position mode");
|
||||||
|
return asynError;
|
||||||
|
}
|
||||||
|
|
||||||
getAxisParamChecked(this, motorEnableRBV, &enabled);
|
getAxisParamChecked(this, motorEnableRBV, &enabled);
|
||||||
getAxisParamChecked(this, motorRecResolution, &motorRecResolution);
|
getAxisParamChecked(this, motorRecResolution, &motorRecResolution);
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user