Compare commits
20 Commits
makefile-f
...
1.4.2
| Author | SHA1 | Date | |
|---|---|---|---|
| 21a73717a5 | |||
| 2cbb4f9028 | |||
| 23a911206a | |||
| 6553b468c8 | |||
| 954fc82414 | |||
| ff183576ec | |||
| 83f9be3be8 | |||
| 2c0c9a33b7 | |||
| 8bb81b1716 | |||
| c32708e49c | |||
| 14a733fb67 | |||
| 64b932c3ae | |||
| 09897b6125 | |||
| 9d47cd4e24 | |||
| 52fa4e1e78 | |||
| a9e08460d9 | |||
| 37dacbd3ee | |||
| d198dc8c9f | |||
| 13f2ec4fbf | |||
| 6ccb60f263 |
24
.gitea/workflows/action.yaml
Normal file
24
.gitea/workflows/action.yaml
Normal file
@@ -0,0 +1,24 @@
|
|||||||
|
name: Test And Build
|
||||||
|
on: [push]
|
||||||
|
|
||||||
|
jobs:
|
||||||
|
Lint:
|
||||||
|
runs-on: linepics
|
||||||
|
steps:
|
||||||
|
- name: checkout repo
|
||||||
|
uses: actions/checkout@v4
|
||||||
|
- name: cppcheck
|
||||||
|
run: cppcheck --std=c++17 --addon=cert --addon=misc --error-exitcode=1 src/*.cpp
|
||||||
|
- name: formatting
|
||||||
|
run: clang-format --style=file --Werror --dry-run src/*.cpp
|
||||||
|
Build:
|
||||||
|
runs-on: linepics
|
||||||
|
steps:
|
||||||
|
- name: checkout repo
|
||||||
|
uses: actions/checkout@v4
|
||||||
|
with:
|
||||||
|
submodules: 'true'
|
||||||
|
- run: |
|
||||||
|
sed -i 's/ARCH_FILTER=.*/ARCH_FILTER=linux%/' Makefile
|
||||||
|
echo -e "\nIGNORE_SUBMODULES += sinqmotor" >> Makefile
|
||||||
|
make install
|
||||||
@@ -1,48 +0,0 @@
|
|||||||
default:
|
|
||||||
image: docker.psi.ch:5000/sinqdev/sinqepics:latest
|
|
||||||
|
|
||||||
stages:
|
|
||||||
- lint
|
|
||||||
- build
|
|
||||||
- test
|
|
||||||
|
|
||||||
cppcheck:
|
|
||||||
stage: lint
|
|
||||||
script:
|
|
||||||
- cppcheck --std=c++17 --addon=cert --addon=misc --suppress=cert-STR07-C --error-exitcode=1 src/*.cpp
|
|
||||||
artifacts:
|
|
||||||
expire_in: 1 week
|
|
||||||
tags:
|
|
||||||
- sinq
|
|
||||||
|
|
||||||
formatting:
|
|
||||||
stage: lint
|
|
||||||
script:
|
|
||||||
- clang-format --style=file --Werror --dry-run src/*.cpp
|
|
||||||
artifacts:
|
|
||||||
expire_in: 1 week
|
|
||||||
tags:
|
|
||||||
- sinq
|
|
||||||
|
|
||||||
build_module:
|
|
||||||
stage: build
|
|
||||||
script:
|
|
||||||
- export SINQMOTOR_VERSION="$(grep 'sinqMotor_VERSION=' Makefile | cut -d= -f2)"
|
|
||||||
- git clone --depth 1 --branch "${SINQMOTOR_VERSION}" https://gitlab-ci-token:${CI_JOB_TOKEN}@git.psi.ch/sinq-epics-modules/sinqmotor.git
|
|
||||||
- pushd sinqmotor
|
|
||||||
- sed -i 's/ARCH_FILTER=.*/ARCH_FILTER=linux%/' Makefile
|
|
||||||
- echo "LIBVERSION=${SINQMOTOR_VERSION}" >> Makefile
|
|
||||||
- make install
|
|
||||||
- popd
|
|
||||||
- sed -i 's/ARCH_FILTER=.*/ARCH_FILTER=linux%/' Makefile
|
|
||||||
- echo "LIBVERSION=${CI_COMMIT_TAG:-0.0.1}" >> Makefile
|
|
||||||
- make install
|
|
||||||
- cp -rT "/ioc/modules/masterMacs/$(ls -U /ioc/modules/masterMacs/ | head -1)" "./masterMacs-${CI_COMMIT_TAG:-$CI_COMMIT_SHORT_SHA}"
|
|
||||||
artifacts:
|
|
||||||
name: "masterMacs-${CI_COMMIT_TAG:-$CI_COMMIT_SHORT_SHA}"
|
|
||||||
paths:
|
|
||||||
- "masterMacs-${CI_COMMIT_TAG:-$CI_COMMIT_SHORT_SHA}/*"
|
|
||||||
expire_in: 1 week
|
|
||||||
when: always
|
|
||||||
tags:
|
|
||||||
- sinq
|
|
||||||
3
Makefile
3
Makefile
@@ -4,7 +4,7 @@ include /ioc/tools/driver.makefile
|
|||||||
MODULE=masterMacs
|
MODULE=masterMacs
|
||||||
BUILDCLASSES=Linux
|
BUILDCLASSES=Linux
|
||||||
EPICS_VERSIONS=7.0.7
|
EPICS_VERSIONS=7.0.7
|
||||||
ARCH_FILTER=RHEL8%
|
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.2.2
|
motorBase_VERSION=7.2.2
|
||||||
@@ -23,6 +23,7 @@ SOURCES += src/masterMacsController.cpp
|
|||||||
# Store the record files
|
# Store the record files
|
||||||
TEMPLATES += sinqMotor/db/asynRecord.db
|
TEMPLATES += sinqMotor/db/asynRecord.db
|
||||||
TEMPLATES += sinqMotor/db/sinqMotor.db
|
TEMPLATES += sinqMotor/db/sinqMotor.db
|
||||||
|
TEMPLATES += db/masterMacs.db
|
||||||
|
|
||||||
# This file registers the motor-specific functions in the IOC shell.
|
# This file registers the motor-specific functions in the IOC shell.
|
||||||
DBDS += sinqMotor/src/sinqMotor.dbd
|
DBDS += sinqMotor/src/sinqMotor.dbd
|
||||||
|
|||||||
@@ -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","$(sinqMotor_DB)/sinqMotor.db")
|
epicsEnvSet("SINQDBPATH","$(masterMacs_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("$(sinqMotor_DB)/asynRecord.db","P=$(INSTR)$(NAME),PORT=$(ASYN_PORT)")
|
dbLoadRecords("$(masterMacs_DB)/asynRecord.db","P=$(INSTR)$(NAME),PORT=$(ASYN_PORT)")
|
||||||
```
|
```
|
||||||
|
|
||||||
### Versioning
|
### Versioning
|
||||||
|
|||||||
7
db/masterMacs.db
Executable file
7
db/masterMacs.db
Executable file
@@ -0,0 +1,7 @@
|
|||||||
|
# Call the nodeReset function of the corresponding masterMacsAxis.
|
||||||
|
# This record is coupled to the parameter library via nodeReset_ -> NODE_RESET.
|
||||||
|
record(longout, "$(INSTR)$(M):NodeReset") {
|
||||||
|
field(DTYP, "asynInt32")
|
||||||
|
field(OUT, "@asyn($(CONTROLLER),$(AXIS),1) NODE_RESET")
|
||||||
|
field(PINI, "NO")
|
||||||
|
}
|
||||||
Submodule sinqMotor updated: c2eca33ce8...7a0de4e9d9
@@ -19,7 +19,6 @@ struct masterMacsAxisImpl {
|
|||||||
std::bitset<16> axisStatus;
|
std::bitset<16> axisStatus;
|
||||||
std::bitset<16> axisError;
|
std::bitset<16> axisError;
|
||||||
|
|
||||||
double lastSetSpeed;
|
|
||||||
bool waitForHandshake;
|
bool waitForHandshake;
|
||||||
time_t timeAtHandshake;
|
time_t timeAtHandshake;
|
||||||
bool needInit = true;
|
bool needInit = true;
|
||||||
@@ -122,7 +121,6 @@ masterMacsAxis::masterMacsAxis(masterMacsController *pC, int axisNo)
|
|||||||
pMasterMacsA_ = std::make_unique<masterMacsAxisImpl>((masterMacsAxisImpl){
|
pMasterMacsA_ = std::make_unique<masterMacsAxisImpl>((masterMacsAxisImpl){
|
||||||
.axisStatus = std::bitset<16>(0),
|
.axisStatus = std::bitset<16>(0),
|
||||||
.axisError = std::bitset<16>(0),
|
.axisError = std::bitset<16>(0),
|
||||||
.lastSetSpeed = 0.0,
|
|
||||||
.waitForHandshake = false,
|
.waitForHandshake = false,
|
||||||
.timeAtHandshake = 0,
|
.timeAtHandshake = 0,
|
||||||
.targetReachedUninitialized = true,
|
.targetReachedUninitialized = true,
|
||||||
@@ -262,11 +260,6 @@ asynStatus masterMacsAxis::init() {
|
|||||||
__PRETTY_FUNCTION__, __LINE__);
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
}
|
}
|
||||||
|
|
||||||
// Cache the motor speed. If this value differs from the one in the motor
|
|
||||||
// record at the start of a movement, the motor record value is sent to
|
|
||||||
// MasterMACS.
|
|
||||||
pMasterMacsA_->lastSetSpeed = motorVelocity;
|
|
||||||
|
|
||||||
// Store the motor position in the parameter library
|
// Store the motor position in the parameter library
|
||||||
pl_status = setMotorPosition(motorPosition);
|
pl_status = setMotorPosition(motorPosition);
|
||||||
if (pl_status != asynSuccess) {
|
if (pl_status != asynSuccess) {
|
||||||
@@ -363,14 +356,11 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
}
|
}
|
||||||
|
|
||||||
if (timedOut) {
|
if (timedOut) {
|
||||||
pl_status =
|
setAxisParamChecked(this, motorMessageText,
|
||||||
setStringParam(pC_->motorMessageText(),
|
"Timed out while waiting for a handshake. "
|
||||||
"Timed out while waiting for a handshake");
|
"Please call the support.");
|
||||||
if (pl_status != asynSuccess) {
|
|
||||||
return pC_->paramLibAccessFailed(pl_status, "motorMessageText_",
|
poll_status = asynError;
|
||||||
axisNo_, __PRETTY_FUNCTION__,
|
|
||||||
__LINE__);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
pC_->read(axisNo_, 86, response);
|
pC_->read(axisNo_, 86, response);
|
||||||
@@ -390,36 +380,15 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
pMasterMacsA_->waitForHandshake = false;
|
pMasterMacsA_->waitForHandshake = false;
|
||||||
pMasterMacsA_->targetReachedUninitialized = false;
|
pMasterMacsA_->targetReachedUninitialized = false;
|
||||||
} else {
|
} else {
|
||||||
// Still waiting for the handshake - try again in the next busy
|
|
||||||
// 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 poll_status;
|
||||||
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;
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Motor resolution from parameter library
|
// Motor resolution from parameter library
|
||||||
pl_status = pC_->getDoubleParam(axisNo_, pC_->motorRecResolution(),
|
getAxisParamChecked(this, motorRecResolution, &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);
|
||||||
@@ -433,6 +402,9 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
return rw_status;
|
return rw_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// If we wait for a handshake, but the motor was moving in its last poll
|
||||||
|
// cycle and has reached its target, it is not moving. Otherwise it is
|
||||||
|
// considered moving, even if we're still waiting for the handshake.
|
||||||
if (pMasterMacsA_->targetReachedUninitialized) {
|
if (pMasterMacsA_->targetReachedUninitialized) {
|
||||||
*moving = false;
|
*moving = false;
|
||||||
} else {
|
} else {
|
||||||
@@ -462,195 +434,181 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
Read out the error if either a fault condition status flag has been set or
|
Read out the error if either a fault condition status flag has been set or
|
||||||
if a movement has just ended.
|
if a movement has just ended.
|
||||||
*/
|
*/
|
||||||
|
if (faultConditionSet() || !(*moving)) {
|
||||||
|
rw_status = readAxisError();
|
||||||
|
}
|
||||||
|
|
||||||
msgPrintControlKey keyError = msgPrintControlKey(
|
msgPrintControlKey keyError = msgPrintControlKey(
|
||||||
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
|
||||||
|
|
||||||
if (faultConditionSet() || !(*moving)) {
|
/*
|
||||||
rw_status = readAxisError();
|
A communication error is a special case. If a communication between
|
||||||
|
controller and axis error occurred, all subsequent errors are ignored,
|
||||||
|
since this information is not reliable.
|
||||||
|
*/
|
||||||
|
if (communicationError()) {
|
||||||
|
if (pC_->getMsgPrintControl().shouldBePrinted(keyError, true,
|
||||||
|
pC_->pasynUser())) {
|
||||||
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
|
"Controller \"%s\", axis %d => %s, line "
|
||||||
|
"%d\nCommunication error.%s\n",
|
||||||
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
|
||||||
|
pC_->getMsgPrintControl().getSuffix());
|
||||||
|
}
|
||||||
|
|
||||||
|
setAxisParamChecked(this, motorMessageText,
|
||||||
|
"Communication error between PC and motor "
|
||||||
|
"controller. Please call the support.");
|
||||||
|
|
||||||
|
poll_status = asynError;
|
||||||
|
} else {
|
||||||
|
|
||||||
|
// This buffer must be initialized to zero because we build the
|
||||||
|
// error message by appending strings.
|
||||||
|
char errorMessage[pC_->MAXBUF_] = {0};
|
||||||
|
char shellMessage[pC_->MAXBUF_] = {0};
|
||||||
|
|
||||||
|
// Concatenate all other errors
|
||||||
|
if (shortCircuit()) {
|
||||||
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
|
"Short circuit fault.");
|
||||||
|
appendErrorMessage(errorMessage, sizeof(errorMessage),
|
||||||
|
"Short circuit error. Please call the support.");
|
||||||
|
|
||||||
|
poll_status = asynError;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (encoderError()) {
|
||||||
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
|
"Encoder error.");
|
||||||
|
appendErrorMessage(errorMessage, sizeof(errorMessage),
|
||||||
|
"Encoder error. Please call the support.");
|
||||||
|
|
||||||
|
poll_status = asynError;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (followingError()) {
|
||||||
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
|
"Maximum callowed following error exceeded.");
|
||||||
|
appendErrorMessage(
|
||||||
|
errorMessage, sizeof(errorMessage),
|
||||||
|
"Maximum allowed following error exceeded.Check if "
|
||||||
|
"movement range is blocked. Otherwise please call the "
|
||||||
|
"support.");
|
||||||
|
|
||||||
|
poll_status = asynError;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (feedbackError()) {
|
||||||
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
|
"Feedback error.");
|
||||||
|
appendErrorMessage(errorMessage, sizeof(errorMessage),
|
||||||
|
"Feedback error. Please call the support.");
|
||||||
|
|
||||||
|
poll_status = asynError;
|
||||||
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
A communication error is a special case. If a communication between
|
Either the software limits or the end switches of the controller
|
||||||
controller and axis error occurred, all subsequent errors are ignored,
|
have been hit. Since the EPICS limits are derived from the software
|
||||||
since this information is not reliable.
|
limits and are a little bit smaller, these error cases can only
|
||||||
*/
|
happen if either the axis has an incremental encoder which is not
|
||||||
if (communicationError()) {
|
properly homed or if a bug occured.
|
||||||
|
*/
|
||||||
|
if (positiveLimitSwitch() || negativeLimitSwitch() ||
|
||||||
|
positiveSoftwareLimit() || negativeSoftwareLimit()) {
|
||||||
|
|
||||||
|
// Distinction for developers
|
||||||
|
if (positiveLimitSwitch()) {
|
||||||
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
|
"Positive limit switch.");
|
||||||
|
}
|
||||||
|
if (negativeLimitSwitch()) {
|
||||||
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
|
"Negative limit switch.");
|
||||||
|
}
|
||||||
|
if (positiveSoftwareLimit()) {
|
||||||
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
|
"Positive software limit.");
|
||||||
|
}
|
||||||
|
if (negativeSoftwareLimit()) {
|
||||||
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
|
"Negative software limit.");
|
||||||
|
}
|
||||||
|
|
||||||
|
// Generic error message for user
|
||||||
|
appendErrorMessage(
|
||||||
|
errorMessage, sizeof(errorMessage),
|
||||||
|
"Software limits or end switch hit. Try homing the motor, "
|
||||||
|
"moving in the opposite direction or check the SPS for "
|
||||||
|
"errors (if available). Otherwise please call the "
|
||||||
|
"support.");
|
||||||
|
|
||||||
|
poll_status = asynError;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (overCurrent()) {
|
||||||
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
|
"Overcurrent error.");
|
||||||
|
appendErrorMessage(errorMessage, sizeof(errorMessage),
|
||||||
|
"Overcurrent error. Please call the support.");
|
||||||
|
|
||||||
|
poll_status = asynError;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (overTemperature()) {
|
||||||
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
|
"Overtemperature error.");
|
||||||
|
appendErrorMessage(
|
||||||
|
errorMessage, sizeof(errorMessage),
|
||||||
|
"Overtemperature error. Please call the support.");
|
||||||
|
|
||||||
|
poll_status = asynError;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (overVoltage()) {
|
||||||
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
|
"Overvoltage error.");
|
||||||
|
appendErrorMessage(errorMessage, sizeof(errorMessage),
|
||||||
|
"Overvoltage error. Please call the support.");
|
||||||
|
|
||||||
|
poll_status = asynError;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (underVoltage()) {
|
||||||
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
|
"Undervoltage error.");
|
||||||
|
appendErrorMessage(errorMessage, sizeof(errorMessage),
|
||||||
|
"Undervoltage error. Please call the support.");
|
||||||
|
|
||||||
|
poll_status = asynError;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (stoFault()) {
|
||||||
|
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
||||||
|
"STO input is on disable state.");
|
||||||
|
appendErrorMessage(errorMessage, sizeof(errorMessage),
|
||||||
|
"STO fault. Please call the support.");
|
||||||
|
|
||||||
|
poll_status = asynError;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (strlen(shellMessage) > 0) {
|
||||||
if (pC_->getMsgPrintControl().shouldBePrinted(keyError, true,
|
if (pC_->getMsgPrintControl().shouldBePrinted(keyError, true,
|
||||||
pC_->pasynUser())) {
|
pC_->pasynUser())) {
|
||||||
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line "
|
"Controller \"%s\", axis %d => %s, line "
|
||||||
"%d\nCommunication error.%s\n",
|
"%d\n%s%s\n",
|
||||||
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
|
||||||
pC_->getMsgPrintControl().getSuffix());
|
shellMessage, pC_->getMsgPrintControl().getSuffix());
|
||||||
}
|
|
||||||
|
|
||||||
pl_status =
|
|
||||||
setStringParam(pC_->motorMessageText(),
|
|
||||||
"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;
|
|
||||||
} else {
|
|
||||||
|
|
||||||
// This buffer must be initialized to zero because we build the
|
|
||||||
// error message by appending strings.
|
|
||||||
char errorMessage[pC_->MAXBUF_] = {0};
|
|
||||||
char shellMessage[pC_->MAXBUF_] = {0};
|
|
||||||
|
|
||||||
// Concatenate all other errors
|
|
||||||
if (shortCircuit()) {
|
|
||||||
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
|
||||||
"Short circuit fault.");
|
|
||||||
appendErrorMessage(
|
|
||||||
errorMessage, sizeof(errorMessage),
|
|
||||||
"Short circuit error. Please call the support.");
|
|
||||||
|
|
||||||
poll_status = asynError;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (encoderError()) {
|
|
||||||
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
|
||||||
"Encoder error.");
|
|
||||||
appendErrorMessage(errorMessage, sizeof(errorMessage),
|
|
||||||
"Encoder error. Please call the support.");
|
|
||||||
|
|
||||||
poll_status = asynError;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (followingError()) {
|
|
||||||
appendErrorMessage(
|
|
||||||
shellMessage, sizeof(shellMessage),
|
|
||||||
"Maximum callowed following error exceeded.");
|
|
||||||
appendErrorMessage(
|
|
||||||
errorMessage, sizeof(errorMessage),
|
|
||||||
"Maximum allowed following error exceeded.Check if "
|
|
||||||
"movement range is blocked. Otherwise please call the "
|
|
||||||
"support.");
|
|
||||||
|
|
||||||
poll_status = asynError;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (feedbackError()) {
|
|
||||||
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
|
||||||
"Feedback error.");
|
|
||||||
appendErrorMessage(errorMessage, sizeof(errorMessage),
|
|
||||||
"Feedback error. Please call the support.");
|
|
||||||
|
|
||||||
poll_status = asynError;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
Either the software limits or the end switches of the controller
|
|
||||||
have been hit. Since the EPICS limits are derived from the software
|
|
||||||
limits and are a little bit smaller, these error cases can only
|
|
||||||
happen if either the axis has an incremental encoder which is not
|
|
||||||
properly homed or if a bug occured.
|
|
||||||
*/
|
|
||||||
if (positiveLimitSwitch() || negativeLimitSwitch() ||
|
|
||||||
positiveSoftwareLimit() || negativeSoftwareLimit()) {
|
|
||||||
|
|
||||||
// Distinction for developers
|
|
||||||
if (positiveLimitSwitch()) {
|
|
||||||
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
|
||||||
"Positive limit switch.");
|
|
||||||
}
|
|
||||||
if (negativeLimitSwitch()) {
|
|
||||||
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
|
||||||
"Negative limit switch.");
|
|
||||||
}
|
|
||||||
if (positiveSoftwareLimit()) {
|
|
||||||
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
|
||||||
"Positive software limit.");
|
|
||||||
}
|
|
||||||
if (negativeSoftwareLimit()) {
|
|
||||||
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
|
||||||
"Negative software limit.");
|
|
||||||
}
|
|
||||||
|
|
||||||
// Generic error message for user
|
|
||||||
appendErrorMessage(
|
|
||||||
errorMessage, sizeof(errorMessage),
|
|
||||||
"Software limits or end switch hit. Try homing the motor, "
|
|
||||||
"moving in the opposite direction or check the SPS for "
|
|
||||||
"errors (if available). Otherwise please call the "
|
|
||||||
"support.");
|
|
||||||
|
|
||||||
poll_status = asynError;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (overCurrent()) {
|
|
||||||
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
|
||||||
"Overcurrent error.");
|
|
||||||
appendErrorMessage(
|
|
||||||
errorMessage, sizeof(errorMessage),
|
|
||||||
"Overcurrent error. Please call the support.");
|
|
||||||
|
|
||||||
poll_status = asynError;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (overTemperature()) {
|
|
||||||
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
|
||||||
"Overtemperature error.");
|
|
||||||
appendErrorMessage(
|
|
||||||
errorMessage, sizeof(errorMessage),
|
|
||||||
"Overtemperature error. Please call the support.");
|
|
||||||
|
|
||||||
poll_status = asynError;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (overVoltage()) {
|
|
||||||
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
|
||||||
"Overvoltage error.");
|
|
||||||
appendErrorMessage(
|
|
||||||
errorMessage, sizeof(errorMessage),
|
|
||||||
"Overvoltage error. Please call the support.");
|
|
||||||
|
|
||||||
poll_status = asynError;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (underVoltage()) {
|
|
||||||
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
|
||||||
"Undervoltage error.");
|
|
||||||
appendErrorMessage(
|
|
||||||
errorMessage, sizeof(errorMessage),
|
|
||||||
"Undervoltage error. Please call the support.");
|
|
||||||
|
|
||||||
poll_status = asynError;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (stoFault()) {
|
|
||||||
appendErrorMessage(shellMessage, sizeof(shellMessage),
|
|
||||||
"STO input is on disable state.");
|
|
||||||
appendErrorMessage(errorMessage, sizeof(errorMessage),
|
|
||||||
"STO fault. Please call the support.");
|
|
||||||
|
|
||||||
poll_status = asynError;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (strlen(shellMessage) > 0) {
|
|
||||||
if (pC_->getMsgPrintControl().shouldBePrinted(
|
|
||||||
keyError, true, pC_->pasynUser())) {
|
|
||||||
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
|
||||||
"Controller \"%s\", axis %d => %s, line "
|
|
||||||
"%d\n%s%s\n",
|
|
||||||
pC_->portName, axisNo_, __PRETTY_FUNCTION__,
|
|
||||||
__LINE__, shellMessage,
|
|
||||||
pC_->getMsgPrintControl().getSuffix());
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
pl_status = setStringParam(pC_->motorMessageText(), errorMessage);
|
|
||||||
if (pl_status != asynSuccess) {
|
|
||||||
return pC_->paramLibAccessFailed(pl_status, "motorMessageText_",
|
|
||||||
axisNo_, __PRETTY_FUNCTION__,
|
|
||||||
__LINE__);
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
} else {
|
|
||||||
|
setAxisParamChecked(this, motorMessageText, errorMessage);
|
||||||
|
}
|
||||||
|
|
||||||
|
// No error has been detected -> Reset the error count
|
||||||
|
if (poll_status == asynSuccess) {
|
||||||
pC_->getMsgPrintControl().resetCount(keyError, pC_->pasynUser());
|
pC_->getMsgPrintControl().resetCount(keyError, pC_->pasynUser());
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -689,40 +647,18 @@ 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.
|
||||||
*/
|
*/
|
||||||
pl_status = pC_->getDoubleParam(axisNo_, pC_->motorLimitsOffset(),
|
getAxisParamChecked(this, motorLimitsOffset, &limitsOffset);
|
||||||
&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;
|
||||||
|
|
||||||
pl_status = pC_->setDoubleParam(
|
setAxisParamChecked(this, motorHighLimitFromDriver, highLimit);
|
||||||
axisNo_, pC_->motorHighLimitFromDriver(), highLimit);
|
setAxisParamChecked(this, motorLowLimitFromDriver, lowLimit);
|
||||||
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
|
||||||
pl_status = setIntegerParam(pC_->motorEnableRBV(),
|
setAxisParamChecked(this, 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
|
||||||
@@ -735,38 +671,16 @@ asynStatus masterMacsAxis::doPoll(bool *moving) {
|
|||||||
|
|
||||||
// Update the parameter library
|
// Update the parameter library
|
||||||
if (hasError) {
|
if (hasError) {
|
||||||
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
setAxisParamChecked(this, 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) {
|
||||||
return pl_status;
|
return pl_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
return poll_status;
|
return poll_status;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -775,10 +689,7 @@ 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 rw_status = asynSuccess;
|
asynStatus 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;
|
||||||
@@ -789,19 +700,8 @@ asynStatus masterMacsAxis::doMove(double position, int relative,
|
|||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
pl_status = pC_->getIntegerParam(axisNo_, pC_->motorEnableRBV(), &enabled);
|
getAxisParamChecked(this, motorEnableRBV, &enabled);
|
||||||
if (pl_status != asynSuccess) {
|
getAxisParamChecked(this, motorRecResolution, &motorRecResolution);
|
||||||
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,
|
||||||
@@ -821,42 +721,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
|
||||||
pl_status = pC_->getIntegerParam(axisNo_, pC_->motorCanSetSpeed(),
|
getAxisParamChecked(this, motorCanSetSpeed, &motorCanSetSpeed);
|
||||||
&motorCanSetSpeed);
|
|
||||||
if (pl_status != asynSuccess) {
|
|
||||||
return pC_->paramLibAccessFailed(pl_status, "motorCanSetSpeed_",
|
|
||||||
axisNo_, __PRETTY_FUNCTION__,
|
|
||||||
__LINE__);
|
|
||||||
}
|
|
||||||
|
|
||||||
// Initialize the movement handshake
|
// Initialize the movement handshake
|
||||||
rw_status = pC_->write(axisNo_, 86, "0");
|
status = pC_->write(axisNo_, 86, "0");
|
||||||
if (rw_status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
setAxisParamChecked(this, motorStatusProblem, true);
|
||||||
if (pl_status != asynSuccess) {
|
return status;
|
||||||
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
|
||||||
// motor speed changed since the last move command.
|
// motor speed changed since the last move command.
|
||||||
if (motorCanSetSpeed != 0 && pMasterMacsA_->lastSetSpeed != motorVelocity) {
|
if (motorCanSetSpeed != 0) {
|
||||||
|
|
||||||
pMasterMacsA_->lastSetSpeed = motorVelocity;
|
|
||||||
|
|
||||||
snprintf(value, sizeof(value), "%lf", motorVelocity);
|
snprintf(value, sizeof(value), "%lf", motorVelocity);
|
||||||
rw_status = pC_->write(axisNo_, 05, value);
|
status = pC_->write(axisNo_, 05, value);
|
||||||
if (rw_status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
setAxisParamChecked(this, motorStatusProblem, true);
|
||||||
if (pl_status != asynSuccess) {
|
return status;
|
||||||
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,
|
||||||
@@ -868,15 +750,10 @@ 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);
|
||||||
rw_status = pC_->write(axisNo_, 02, value);
|
status = pC_->write(axisNo_, 02, value);
|
||||||
if (rw_status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
setAxisParamChecked(this, motorStatusProblem, true);
|
||||||
if (pl_status != asynSuccess) {
|
return status;
|
||||||
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
|
||||||
@@ -888,18 +765,13 @@ asynStatus masterMacsAxis::doMove(double position, int relative,
|
|||||||
|
|
||||||
// Start the move
|
// Start the move
|
||||||
if (relative) {
|
if (relative) {
|
||||||
rw_status = pC_->write(axisNo_, 00, "2", timeout);
|
status = pC_->write(axisNo_, 00, "2", timeout);
|
||||||
} else {
|
} else {
|
||||||
rw_status = pC_->write(axisNo_, 00, "1", timeout);
|
status = pC_->write(axisNo_, 00, "1", timeout);
|
||||||
}
|
}
|
||||||
if (rw_status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
setAxisParamChecked(this, motorStatusProblem, true);
|
||||||
if (pl_status != asynSuccess) {
|
return status;
|
||||||
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
|
||||||
@@ -913,60 +785,61 @@ asynStatus masterMacsAxis::doMove(double position, int relative,
|
|||||||
return asynError;
|
return asynError;
|
||||||
}
|
}
|
||||||
|
|
||||||
return rw_status;
|
return status;
|
||||||
}
|
}
|
||||||
|
|
||||||
asynStatus masterMacsAxis::stop(double acceleration) {
|
asynStatus masterMacsAxis::stop(double acceleration) {
|
||||||
|
|
||||||
// Status of read-write-operations of ASCII commands to the controller
|
asynStatus status = pC_->write(axisNo_, 00, "8");
|
||||||
asynStatus rw_status = asynSuccess;
|
if (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 rw_status;
|
return status;
|
||||||
}
|
}
|
||||||
|
|
||||||
asynStatus masterMacsAxis::doReset() {
|
asynStatus masterMacsAxis::doReset() {
|
||||||
// Status of read-write-operations of ASCII commands to the controller
|
|
||||||
asynStatus rw_status = asynSuccess;
|
|
||||||
|
|
||||||
// Status of parameter library operations
|
asynStatus status = asynSuccess;
|
||||||
asynStatus pl_status = asynSuccess;
|
|
||||||
|
|
||||||
// =========================================================================
|
// Reset any errors
|
||||||
|
status = pC_->write(axisNo_, 17, "");
|
||||||
rw_status = pC_->write(axisNo_, 17, "");
|
if (status != asynSuccess) {
|
||||||
if (rw_status != asynSuccess) {
|
setAxisParamChecked(this, motorStatusProblem, true);
|
||||||
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,
|
// 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 rw_status;
|
// Disable the axis
|
||||||
|
return enable(false);
|
||||||
|
}
|
||||||
|
|
||||||
|
asynStatus masterMacsAxis::nodeReset() {
|
||||||
|
|
||||||
|
asynStatus status = asynSuccess;
|
||||||
|
|
||||||
|
// Reset the controller ("node reset"). Since the node reset results in a
|
||||||
|
// power cycle, we use the corresponding timeout.
|
||||||
|
status = pC_->write(axisNo_, 16, "", PowerCycleTimeout);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
setAxisParamChecked(this, motorStatusProblem, true);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Move out of the handshake wait loop, if we're currently inside it.
|
||||||
|
pMasterMacsA_->waitForHandshake = false;
|
||||||
|
|
||||||
|
// Reinitialize the axis
|
||||||
|
status = masterMacsAxis::init();
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
bool moving = false;
|
||||||
|
return forcedPoll(&moving);
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@@ -975,41 +848,25 @@ 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};
|
||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
pl_status = pC_->getStringParam(axisNo_, pC_->encoderType(),
|
getAxisParamChecked(this, encoderType, &response);
|
||||||
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
|
||||||
rw_status = pC_->write(axisNo_, 86, "0");
|
asynStatus status = pC_->write(axisNo_, 86, "0");
|
||||||
if (rw_status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
pl_status = setIntegerParam(pC_->motorStatusProblem(), true);
|
setAxisParamChecked(this, motorStatusProblem, true);
|
||||||
if (pl_status != asynSuccess) {
|
return status;
|
||||||
return pC_->paramLibAccessFailed(pl_status,
|
|
||||||
"motorStatusProblem_", axisNo_,
|
|
||||||
__PRETTY_FUNCTION__, __LINE__);
|
|
||||||
}
|
|
||||||
return rw_status;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
rw_status = pC_->write(axisNo_, 00, "9");
|
status = pC_->write(axisNo_, 00, "9");
|
||||||
if (rw_status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
return rw_status;
|
return 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
|
||||||
@@ -1027,12 +884,6 @@ 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;
|
||||||
@@ -1041,9 +892,9 @@ asynStatus masterMacsAxis::readEncoderType() {
|
|||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
// Check if this is an absolute encoder
|
// Check if this is an absolute encoder
|
||||||
rw_status = pC_->read(axisNo_, 60, response);
|
asynStatus status = pC_->read(axisNo_, 60, response);
|
||||||
if (rw_status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
return rw_status;
|
return status;
|
||||||
}
|
}
|
||||||
|
|
||||||
nvals = sscanf(response, "%d", &encoder_id);
|
nvals = sscanf(response, "%d", &encoder_id);
|
||||||
@@ -1059,28 +910,18 @@ 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) {
|
||||||
pl_status = setStringParam(pC_->encoderType(), IncrementalEncoder);
|
setAxisParamChecked(this, encoderType, IncrementalEncoder);
|
||||||
} else {
|
} else {
|
||||||
pl_status = setStringParam(pC_->encoderType(), AbsoluteEncoder);
|
setAxisParamChecked(this, 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 value[pC_->MAXBUF_];
|
char msg[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;
|
|
||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
@@ -1110,14 +951,8 @@ 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__);
|
||||||
|
|
||||||
pl_status =
|
setAxisParamChecked(this, motorMessageText,
|
||||||
setStringParam(pC_->motorMessageText(),
|
"Axis cannot be disabled while it is moving.");
|
||||||
"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;
|
||||||
}
|
}
|
||||||
@@ -1135,7 +970,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(value, sizeof(value), "%d", on);
|
snprintf(msg, sizeof(msg), "%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__,
|
||||||
@@ -1150,9 +985,9 @@ asynStatus masterMacsAxis::enable(bool on) {
|
|||||||
timeout = PowerCycleTimeout;
|
timeout = PowerCycleTimeout;
|
||||||
}
|
}
|
||||||
|
|
||||||
rw_status = pC_->write(axisNo_, 04, value, timeout);
|
asynStatus status = pC_->write(axisNo_, 04, msg, timeout);
|
||||||
if (rw_status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
return rw_status;
|
return 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
|
||||||
@@ -1162,15 +997,15 @@ asynStatus masterMacsAxis::enable(bool on) {
|
|||||||
|
|
||||||
// Read the axis status
|
// Read the axis status
|
||||||
usleep(100000);
|
usleep(100000);
|
||||||
rw_status = readAxisStatus();
|
status = readAxisStatus();
|
||||||
if (rw_status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
return rw_status;
|
return status;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (switchedOn() == on) {
|
if (switchedOn() == on) {
|
||||||
bool moving = false;
|
bool moving = false;
|
||||||
// Perform a poll to update the parameter library
|
// Perform a poll to update the parameter library
|
||||||
poll(&moving);
|
forcedPoll(&moving);
|
||||||
return asynSuccess;
|
return asynSuccess;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -1184,14 +1019,10 @@ 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(value, sizeof(value), "Failed to %s within %d seconds",
|
snprintf(msg, sizeof(msg), "Failed to %s within %d seconds",
|
||||||
on ? "enable" : "disable", timeout_enable_disable);
|
on ? "enable" : "disable", timeout_enable_disable);
|
||||||
pl_status = setStringParam(pC_->motorMessageText(), value);
|
|
||||||
if (pl_status != asynSuccess) {
|
setAxisParamChecked(this, motorMessageText, msg);
|
||||||
return pC_->paramLibAccessFailed(pl_status, "motorMessageText_",
|
|
||||||
axisNo_, __PRETTY_FUNCTION__,
|
|
||||||
__LINE__);
|
|
||||||
}
|
|
||||||
return asynError;
|
return asynError;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
@@ -1,16 +1,12 @@
|
|||||||
#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
|
struct HIDDEN masterMacsAxisImpl;
|
||||||
// between the controller and the axis .h-file. See
|
|
||||||
// https://en.cppreference.com/w/cpp/language/class.
|
|
||||||
class masterMacsController;
|
|
||||||
|
|
||||||
struct masterMacsAxisImpl;
|
class HIDDEN masterMacsAxis : public sinqAxis {
|
||||||
|
|
||||||
class masterMacsAxis : public sinqAxis {
|
|
||||||
public:
|
public:
|
||||||
/**
|
/**
|
||||||
* @brief Construct a new masterMacsAxis
|
* @brief Construct a new masterMacsAxis
|
||||||
@@ -79,12 +75,27 @@ class masterMacsAxis : public sinqAxis {
|
|||||||
*/
|
*/
|
||||||
asynStatus doReset();
|
asynStatus doReset();
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Performs a "node reset" on the axis as defined in the CANopen
|
||||||
|
* standard
|
||||||
|
*
|
||||||
|
* A "node reset" is a factory reset on the axis which completely deletes
|
||||||
|
* all configured information (e.g. limits or speed) from the axis. The
|
||||||
|
* MasterMACS controller then reapplies the initial configuration to this
|
||||||
|
* axis. It can therefore be seen as a "hard" version of the normal error
|
||||||
|
* reset performed by the `doReset` method.
|
||||||
|
*
|
||||||
|
* @return asynStatus
|
||||||
|
*/
|
||||||
|
asynStatus nodeReset();
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Readout of some values from the controller at IOC startup
|
* @brief Readout of some values from the controller at IOC startup
|
||||||
*
|
*
|
||||||
* The following steps are performed:
|
* The following steps are performed:
|
||||||
* - Read out the motor status, motor position, velocity and acceleration
|
* - Read out the motor status, motor position, velocity and
|
||||||
* from the MCU and store this information in the parameter library.
|
* acceleration from the MCU and store this information in the parameter
|
||||||
|
* library.
|
||||||
* - Set the enable PV accordint to the initial status of the axis.
|
* - Set the enable PV accordint to the initial status of the axis.
|
||||||
*
|
*
|
||||||
* @return asynStatus
|
* @return asynStatus
|
||||||
@@ -100,8 +111,8 @@ class masterMacsAxis : public sinqAxis {
|
|||||||
asynStatus enable(bool on);
|
asynStatus enable(bool on);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Read the encoder type (incremental or absolute) for this axis from
|
* @brief Read the encoder type (incremental or absolute) for this axis
|
||||||
* the MCU and store the information in the PV ENCODER_TYPE.
|
* from the MCU and store the information in the PV ENCODER_TYPE.
|
||||||
*
|
*
|
||||||
* @return asynStatus
|
* @return asynStatus
|
||||||
*/
|
*/
|
||||||
@@ -116,17 +127,21 @@ class masterMacsAxis : public sinqAxis {
|
|||||||
bool needInit();
|
bool needInit();
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Instruct the axis to run its init() function during the next poll
|
* @brief Instruct the axis to run its init() function during the next
|
||||||
|
* poll
|
||||||
*
|
*
|
||||||
* @param needInit
|
* @param needInit
|
||||||
*/
|
*/
|
||||||
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
|
||||||
* result in axisStatus_
|
* the result in axisStatus_
|
||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
asynStatus readAxisStatus();
|
asynStatus readAxisStatus();
|
||||||
@@ -204,8 +219,8 @@ class masterMacsAxis : public sinqAxis {
|
|||||||
bool powerEnabled();
|
bool powerEnabled();
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @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
|
||||||
* result in axisStatus_
|
* the result in axisStatus_
|
||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
asynStatus readAxisError();
|
asynStatus readAxisError();
|
||||||
|
|||||||
@@ -14,6 +14,9 @@
|
|||||||
|
|
||||||
struct masterMacsControllerImpl {
|
struct masterMacsControllerImpl {
|
||||||
double comTimeout;
|
double comTimeout;
|
||||||
|
|
||||||
|
// Indices of additional ParamLib entries
|
||||||
|
int nodeReset;
|
||||||
};
|
};
|
||||||
|
|
||||||
/**
|
/**
|
||||||
@@ -68,6 +71,20 @@ masterMacsController::masterMacsController(const char *portName,
|
|||||||
.comTimeout = comTimeout,
|
.comTimeout = comTimeout,
|
||||||
});
|
});
|
||||||
|
|
||||||
|
// =========================================================================
|
||||||
|
// Create additional parameter library entries
|
||||||
|
|
||||||
|
status =
|
||||||
|
createParam("NODE_RESET", asynParamInt32, &pMasterMacsC_->nodeReset);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
asynPrint(this->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
|
"Controller \"%s\" => %s, line %d\nFATAL ERROR (creating a "
|
||||||
|
"parameter failed with %s).\nTerminating IOC",
|
||||||
|
portName, __PRETTY_FUNCTION__, __LINE__,
|
||||||
|
stringifyAsynStatus(status));
|
||||||
|
exit(-1);
|
||||||
|
}
|
||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@@ -120,6 +137,22 @@ masterMacsAxis *masterMacsController::getMasterMacsAxis(int axisNo) {
|
|||||||
return dynamic_cast<masterMacsAxis *>(asynAxis);
|
return dynamic_cast<masterMacsAxis *>(asynAxis);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
asynStatus masterMacsController::writeInt32(asynUser *pasynUser,
|
||||||
|
epicsInt32 value) {
|
||||||
|
int function = pasynUser->reason;
|
||||||
|
|
||||||
|
// =====================================================================
|
||||||
|
|
||||||
|
masterMacsAxis *axis = getMasterMacsAxis(pasynUser);
|
||||||
|
|
||||||
|
// Handle custom PVs
|
||||||
|
if (function == nodeReset()) {
|
||||||
|
return axis->nodeReset();
|
||||||
|
} else {
|
||||||
|
return sinqController::writeInt32(pasynUser, value);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
asynStatus masterMacsController::read(int axisNo, int tcpCmd, char *response,
|
asynStatus masterMacsController::read(int axisNo, int tcpCmd, char *response,
|
||||||
double comTimeout) {
|
double comTimeout) {
|
||||||
return writeRead(axisNo, tcpCmd, NULL, response);
|
return writeRead(axisNo, tcpCmd, NULL, response);
|
||||||
@@ -136,7 +169,6 @@ 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};
|
||||||
@@ -255,7 +287,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) {
|
||||||
pl_status = axis->setIntegerParam(this->motorStatusCommsError_, 0);
|
setAxisParamChecked(axis, motorStatusCommsError, false);
|
||||||
} else {
|
} else {
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@@ -274,35 +306,12 @@ 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
|
||||||
*/
|
*/
|
||||||
pl_status =
|
getAxisParamChecked(axis, motorStatusProblem, &motorStatusProblem);
|
||||||
getIntegerParam(axisNo, motorStatusProblem_, &motorStatusProblem);
|
|
||||||
if (pl_status != asynSuccess) {
|
|
||||||
return paramLibAccessFailed(pl_status, "motorStatusProblem", axisNo,
|
|
||||||
__PRETTY_FUNCTION__, __LINE__);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (motorStatusProblem == 0) {
|
if (motorStatusProblem == 0) {
|
||||||
pl_status =
|
setAxisParamChecked(axis, motorMessageText, drvMessageText);
|
||||||
axis->setStringParam(motorMessageText(), drvMessageText);
|
setAxisParamChecked(axis, motorStatusProblem, true);
|
||||||
if (pl_status != asynSuccess) {
|
setAxisParamChecked(axis, motorStatusCommsError, false);
|
||||||
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__);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -332,13 +341,14 @@ asynStatus masterMacsController::parseResponse(
|
|||||||
msgPrintControlKey parseKey =
|
msgPrintControlKey parseKey =
|
||||||
msgPrintControlKey(portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
msgPrintControlKey(portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
||||||
|
|
||||||
// Was the motor previously connected?
|
masterMacsAxis *axis = getMasterMacsAxis(axisNo);
|
||||||
status = getIntegerParam(axisNo, motorConnected(), &prevConnected);
|
if (axis == nullptr) {
|
||||||
if (status != asynSuccess) {
|
return asynError;
|
||||||
return paramLibAccessFailed(status, "motorConnected", axisNo,
|
|
||||||
__PRETTY_FUNCTION__, __LINE__);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Was the motor previously connected?
|
||||||
|
getAxisParamChecked(axis, motorConnected, &prevConnected);
|
||||||
|
|
||||||
// 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.
|
||||||
for (uint32_t i = 0; i < MAXBUF_; i++) {
|
for (uint32_t i = 0; i < MAXBUF_; i++) {
|
||||||
@@ -361,16 +371,7 @@ asynStatus masterMacsController::parseResponse(
|
|||||||
"connected.\n",
|
"connected.\n",
|
||||||
portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
||||||
|
|
||||||
masterMacsAxis *axis = getMasterMacsAxis(axisNo);
|
setAxisParamChecked(axis, motorConnected, true);
|
||||||
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,
|
||||||
@@ -398,16 +399,7 @@ asynStatus masterMacsController::parseResponse(
|
|||||||
"disconnected.\n",
|
"disconnected.\n",
|
||||||
portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
||||||
|
|
||||||
masterMacsAxis *axis = getMasterMacsAxis(axisNo);
|
setAxisParamChecked(axis, motorConnected, false);
|
||||||
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,
|
||||||
@@ -500,6 +492,8 @@ asynStatus masterMacsController::readInt32(asynUser *pasynUser,
|
|||||||
|
|
||||||
double masterMacsController::comTimeout() { return pMasterMacsC_->comTimeout; }
|
double masterMacsController::comTimeout() { return pMasterMacsC_->comTimeout; }
|
||||||
|
|
||||||
|
int masterMacsController::nodeReset() { return pMasterMacsC_->nodeReset; }
|
||||||
|
|
||||||
/***************************************************************************/
|
/***************************************************************************/
|
||||||
/** The following functions are C-wrappers, and can be called directly from
|
/** The following functions are C-wrappers, and can be called directly from
|
||||||
* iocsh */
|
* iocsh */
|
||||||
|
|||||||
@@ -8,14 +8,18 @@
|
|||||||
|
|
||||||
#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>
|
||||||
|
|
||||||
struct masterMacsControllerImpl;
|
// 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 HIDDEN masterMacsAxis;
|
||||||
|
|
||||||
class masterMacsController : public sinqController {
|
struct HIDDEN masterMacsControllerImpl;
|
||||||
|
|
||||||
|
class HIDDEN masterMacsController : public sinqController {
|
||||||
|
|
||||||
public:
|
public:
|
||||||
/**
|
/**
|
||||||
@@ -61,6 +65,17 @@ class masterMacsController : public sinqController {
|
|||||||
*/
|
*/
|
||||||
masterMacsAxis *getMasterMacsAxis(int axisNo);
|
masterMacsAxis *getMasterMacsAxis(int axisNo);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Overloaded function of sinqController
|
||||||
|
*
|
||||||
|
* The function is overloaded to allow resetting the node
|
||||||
|
*
|
||||||
|
* @param pasynUser Specify the axis via the asynUser
|
||||||
|
* @param value New value
|
||||||
|
* @return asynStatus
|
||||||
|
*/
|
||||||
|
virtual asynStatus writeInt32(asynUser *pasynUser, epicsInt32 value);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Send a command to the hardware (S mode)
|
* @brief Send a command to the hardware (S mode)
|
||||||
*
|
*
|
||||||
@@ -137,6 +152,9 @@ class masterMacsController : public sinqController {
|
|||||||
*/
|
*/
|
||||||
double comTimeout();
|
double comTimeout();
|
||||||
|
|
||||||
|
// Accessors for additional PVs
|
||||||
|
int nodeReset();
|
||||||
|
|
||||||
private:
|
private:
|
||||||
std::unique_ptr<masterMacsControllerImpl> pMasterMacsC_;
|
std::unique_ptr<masterMacsControllerImpl> pMasterMacsC_;
|
||||||
};
|
};
|
||||||
|
|||||||
Reference in New Issue
Block a user