Compare commits
24 Commits
| Author | SHA1 | Date | |
|---|---|---|---|
| 1ee483f8e9 | |||
| 002b5d2616 | |||
| ce80426790 | |||
| 72f3965881 | |||
| d41e7bf054 | |||
| 30bfa1cac5 | |||
| 235816fd20 | |||
| bd0966d2c9 | |||
| 9d5d90574a | |||
| 6effc5e906 | |||
| bc5de11b16 | |||
| aa488627f9 | |||
| ccaee6c5d1 | |||
| 323b030581 | |||
| b206012df2 | |||
| 21ec7e8467 | |||
| 398bc8241a | |||
| 8ca684604d | |||
| 72fe2b3681 | |||
| 5911e62029 | |||
| 682024091f | |||
| 335de72bc5 | |||
| 8e5055d6b8 | |||
| 1cab6e14ff |
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,58 +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 --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
|
|
||||||
|
|
||||||
# clangtidy:
|
|
||||||
# stage: lint
|
|
||||||
# script:
|
|
||||||
# - curl https://docker.psi.ch:5000/v2/_catalog
|
|
||||||
# # - dnf update -y
|
|
||||||
# # - dnf install -y clang-tools-extra
|
|
||||||
# # - clang-tidy sinqEPICSApp/src/*.cpp sinqEPICSApp/src/*.c sinqEPICSApp/src/*.h -checks=cppcoreguidelines-*,cert-*
|
|
||||||
# # 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/turboPmac/$(ls -U /ioc/modules/turboPmac/ | head -1)" "./turboPmac-${CI_COMMIT_TAG:-$CI_COMMIT_SHORT_SHA}"
|
|
||||||
artifacts:
|
|
||||||
name: "turboPmac-${CI_COMMIT_TAG:-$CI_COMMIT_SHORT_SHA}"
|
|
||||||
paths:
|
|
||||||
- "turboPmac-${CI_COMMIT_TAG:-$CI_COMMIT_SHORT_SHA}/*"
|
|
||||||
expire_in: 1 week
|
|
||||||
when: always
|
|
||||||
tags:
|
|
||||||
- sinq
|
|
||||||
2
Makefile
2
Makefile
@@ -34,4 +34,4 @@ TEMPLATES += db/turboPmac.db
|
|||||||
DBDS += sinqMotor/src/sinqMotor.dbd
|
DBDS += sinqMotor/src/sinqMotor.dbd
|
||||||
DBDS += src/turboPmac.dbd
|
DBDS += src/turboPmac.dbd
|
||||||
|
|
||||||
USR_CFLAGS += -Wall -Wextra -Weffc++ -Wunused-result -Werror # -Wpedantic // Does not work because EPICS macros trigger warnings
|
USR_CFLAGS += -Wall -Wextra -Wunused-result -Werror -fvisibility=hidden # -Wpedantic // Does not work because EPICS macros trigger warnings
|
||||||
Submodule sinqMotor updated: 55a9fe6f3e...7a0de4e9d9
@@ -230,8 +230,7 @@ static asynStatus sendPmacGetBuffer(pmacPvt *pPmacPvt, asynUser *pasynUser,
|
|||||||
|
|
||||||
// =============================================================================
|
// =============================================================================
|
||||||
|
|
||||||
epicsShareFunc int pmacAsynIPPortConfigure(const char *portName,
|
int pmacAsynIPPortConfigure(const char *portName, const char *hostInfo) {
|
||||||
const char *hostInfo) {
|
|
||||||
asynStatus status = asynSuccess;
|
asynStatus status = asynSuccess;
|
||||||
asynInterface *int32LowerLevelInterface = NULL;
|
asynInterface *int32LowerLevelInterface = NULL;
|
||||||
asynInterface *octetLowerLevelInterface = NULL;
|
asynInterface *octetLowerLevelInterface = NULL;
|
||||||
|
|||||||
@@ -2,6 +2,7 @@
|
|||||||
#define asynInterposePmac_H
|
#define asynInterposePmac_H
|
||||||
|
|
||||||
#include <epicsExport.h>
|
#include <epicsExport.h>
|
||||||
|
#include <macros.h>
|
||||||
#include <shareLib.h>
|
#include <shareLib.h>
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@@ -25,8 +26,7 @@ extern "C" {
|
|||||||
* 172.23.243.156:1025)
|
* 172.23.243.156:1025)
|
||||||
* @return status
|
* @return status
|
||||||
*/
|
*/
|
||||||
epicsShareFunc int pmacAsynIPPortConfigure(const char *portName,
|
int HIDDEN pmacAsynIPPortConfigure(const char *portName, const char *hostInfo);
|
||||||
const char *hostInfo);
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
#ifdef __cplusplus
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -15,6 +15,14 @@
|
|||||||
|
|
||||||
struct turboPmacAxisImpl {
|
struct turboPmacAxisImpl {
|
||||||
bool waitForHandshake;
|
bool waitForHandshake;
|
||||||
|
/*
|
||||||
|
This flag is set to true, if the controller is currently enabling /
|
||||||
|
disabling the motor and false otherwise. This flag is used in the doPoll
|
||||||
|
method to check if the enableRBV PV should be set or not in order to prevent
|
||||||
|
a premature change of state (controller reports that the motor is already
|
||||||
|
enabled / disabled while it is not ready yet to receive new commands).
|
||||||
|
*/
|
||||||
|
bool enableDisable;
|
||||||
time_t timeAtHandshake;
|
time_t timeAtHandshake;
|
||||||
// The axis status is used when enabling / disabling the motor
|
// The axis status is used when enabling / disabling the motor
|
||||||
int axisStatus;
|
int axisStatus;
|
||||||
@@ -64,6 +72,7 @@ turboPmacAxis::turboPmacAxis(turboPmacController *pC, int axisNo,
|
|||||||
|
|
||||||
pTurboPmacA_ = std::make_unique<turboPmacAxisImpl>(
|
pTurboPmacA_ = std::make_unique<turboPmacAxisImpl>(
|
||||||
(turboPmacAxisImpl){.waitForHandshake = false,
|
(turboPmacAxisImpl){.waitForHandshake = false,
|
||||||
|
.enableDisable = false,
|
||||||
.timeAtHandshake = 0,
|
.timeAtHandshake = 0,
|
||||||
.axisStatus = 0,
|
.axisStatus = 0,
|
||||||
.needInit = false});
|
.needInit = false});
|
||||||
@@ -253,9 +262,6 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
|
|||||||
double lowLimit = 0.0;
|
double lowLimit = 0.0;
|
||||||
double limitsOffset = 0.0;
|
double limitsOffset = 0.0;
|
||||||
|
|
||||||
// Was the axis idle during the previous poll?
|
|
||||||
int previousStatusDone = 1;
|
|
||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
if (pTurboPmacA_->needInit) {
|
if (pTurboPmacA_->needInit) {
|
||||||
@@ -332,8 +338,6 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
|
|||||||
return status;
|
return status;
|
||||||
}
|
}
|
||||||
|
|
||||||
getAxisParamChecked(this, motorStatusDone, &previousStatusDone);
|
|
||||||
|
|
||||||
// Query the axis status
|
// Query the axis status
|
||||||
snprintf(command, sizeof(command),
|
snprintf(command, sizeof(command),
|
||||||
"P%2.2d00 Q%2.2d10 P%2.2d01 Q%2.2d13 Q%2.2d14", axisNo_, axisNo_,
|
"P%2.2d00 Q%2.2d10 P%2.2d01 Q%2.2d13 Q%2.2d14", axisNo_, axisNo_,
|
||||||
@@ -369,9 +373,12 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
|
|||||||
// Store the axis status
|
// Store the axis status
|
||||||
pTurboPmacA_->axisStatus = axStatus;
|
pTurboPmacA_->axisStatus = axStatus;
|
||||||
|
|
||||||
// Update the enablement PV
|
// Update the enablement PV, if we are not in the middle of a enabling /
|
||||||
setAxisParamChecked(this, motorEnableRBV,
|
// disabling procedure.
|
||||||
(axStatus != -3 && axStatus != -5));
|
if (!(pTurboPmacA_->enableDisable)) {
|
||||||
|
setAxisParamChecked(this, motorEnableRBV,
|
||||||
|
(axStatus != -3 && axStatus != -5));
|
||||||
|
}
|
||||||
|
|
||||||
// Create the unique callsite identifier manually so it can be used later in
|
// Create the unique callsite identifier manually so it can be used later in
|
||||||
// the shouldBePrinted calls.
|
// the shouldBePrinted calls.
|
||||||
@@ -546,11 +553,6 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
|
|||||||
int sizeUserMessage) {
|
int sizeUserMessage) {
|
||||||
asynStatus status = asynError;
|
asynStatus status = asynError;
|
||||||
|
|
||||||
// Create the unique callsite identifier manually so it can be used later in
|
|
||||||
// the shouldBePrinted calls.
|
|
||||||
msgPrintControlKey keyError = msgPrintControlKey(
|
|
||||||
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
|
|
||||||
|
|
||||||
switch (error) {
|
switch (error) {
|
||||||
case 0:
|
case 0:
|
||||||
status = asynSuccess;
|
status = asynSuccess;
|
||||||
@@ -559,8 +561,9 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
|
|||||||
case 1:
|
case 1:
|
||||||
// EPICS should already prevent this issue in the first place,
|
// EPICS should already prevent this issue in the first place,
|
||||||
// since it contains the user limits
|
// since it contains the user limits
|
||||||
if (pC_->getMsgPrintControl().shouldBePrinted(keyError, true,
|
if (pC_->getMsgPrintControl().shouldBePrinted(
|
||||||
pC_->pasynUser())) {
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
|
||||||
|
pC_->pasynUser())) {
|
||||||
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d\nTarget "
|
"Controller \"%s\", axis %d => %s, line %d\nTarget "
|
||||||
"position would exceed user limits.%s\n",
|
"position would exceed user limits.%s\n",
|
||||||
@@ -572,8 +575,9 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
|
|||||||
break;
|
break;
|
||||||
case 5:
|
case 5:
|
||||||
// Command not possible
|
// Command not possible
|
||||||
if (pC_->getMsgPrintControl().shouldBePrinted(keyError, true,
|
if (pC_->getMsgPrintControl().shouldBePrinted(
|
||||||
pC_->pasynUser())) {
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
|
||||||
|
pC_->pasynUser())) {
|
||||||
asynPrint(
|
asynPrint(
|
||||||
pC_->pasynUser(), ASYN_TRACE_ERROR,
|
pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d\nAxis is "
|
"Controller \"%s\", axis %d => %s, line %d\nAxis is "
|
||||||
@@ -587,8 +591,9 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
|
|||||||
"moving. Please call the support.");
|
"moving. Please call the support.");
|
||||||
break;
|
break;
|
||||||
case 8:
|
case 8:
|
||||||
if (pC_->getMsgPrintControl().shouldBePrinted(keyError, true,
|
if (pC_->getMsgPrintControl().shouldBePrinted(
|
||||||
pC_->pasynUser())) {
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
|
||||||
|
pC_->pasynUser())) {
|
||||||
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d\nAir cushion "
|
"Controller \"%s\", axis %d => %s, line %d\nAir cushion "
|
||||||
"feedback stopped during movement (P%2.2d01 = %d).%s\n",
|
"feedback stopped during movement (P%2.2d01 = %d).%s\n",
|
||||||
@@ -602,8 +607,9 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
|
|||||||
setAxisParamChecked(this, motorMessageText, userMessage);
|
setAxisParamChecked(this, motorMessageText, userMessage);
|
||||||
break;
|
break;
|
||||||
case 9:
|
case 9:
|
||||||
if (pC_->getMsgPrintControl().shouldBePrinted(keyError, true,
|
if (pC_->getMsgPrintControl().shouldBePrinted(
|
||||||
pC_->pasynUser())) {
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
|
||||||
|
pC_->pasynUser())) {
|
||||||
asynPrint(
|
asynPrint(
|
||||||
pC_->pasynUser(), ASYN_TRACE_ERROR,
|
pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d\nNo air cushion "
|
"Controller \"%s\", axis %d => %s, line %d\nNo air cushion "
|
||||||
@@ -626,8 +632,9 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
|
|||||||
which is not properly homed or if a bug occured.
|
which is not properly homed or if a bug occured.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
if (pC_->getMsgPrintControl().shouldBePrinted(keyError, true,
|
if (pC_->getMsgPrintControl().shouldBePrinted(
|
||||||
pC_->pasynUser())) {
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
|
||||||
|
pC_->pasynUser())) {
|
||||||
asynPrint(
|
asynPrint(
|
||||||
pC_->pasynUser(), ASYN_TRACE_ERROR,
|
pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d\nAxis hit the "
|
"Controller \"%s\", axis %d => %s, line %d\nAxis hit the "
|
||||||
@@ -646,8 +653,9 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
|
|||||||
case 11:
|
case 11:
|
||||||
// Following error
|
// Following error
|
||||||
|
|
||||||
if (pC_->getMsgPrintControl().shouldBePrinted(keyError, true,
|
if (pC_->getMsgPrintControl().shouldBePrinted(
|
||||||
pC_->pasynUser())) {
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
|
||||||
|
pC_->pasynUser())) {
|
||||||
asynPrint(
|
asynPrint(
|
||||||
pC_->pasynUser(), ASYN_TRACE_ERROR,
|
pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d\nMaximum allowed "
|
"Controller \"%s\", axis %d => %s, line %d\nMaximum allowed "
|
||||||
@@ -664,8 +672,9 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
|
|||||||
break;
|
break;
|
||||||
|
|
||||||
case 12:
|
case 12:
|
||||||
if (pC_->getMsgPrintControl().shouldBePrinted(keyError, true,
|
if (pC_->getMsgPrintControl().shouldBePrinted(
|
||||||
pC_->pasynUser())) {
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
|
||||||
|
pC_->pasynUser())) {
|
||||||
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d\nSecurity "
|
"Controller \"%s\", axis %d => %s, line %d\nSecurity "
|
||||||
"input is triggered (P%2.2d01 = %d).%s\n",
|
"input is triggered (P%2.2d01 = %d).%s\n",
|
||||||
@@ -683,8 +692,9 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
|
|||||||
case 13:
|
case 13:
|
||||||
// Driver hardware error triggered
|
// Driver hardware error triggered
|
||||||
|
|
||||||
if (pC_->getMsgPrintControl().shouldBePrinted(keyError, true,
|
if (pC_->getMsgPrintControl().shouldBePrinted(
|
||||||
pC_->pasynUser())) {
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
|
||||||
|
pC_->pasynUser())) {
|
||||||
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d\nDriver "
|
"Controller \"%s\", axis %d => %s, line %d\nDriver "
|
||||||
"hardware error triggered.%s\n",
|
"hardware error triggered.%s\n",
|
||||||
@@ -700,8 +710,9 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
|
|||||||
case 14:
|
case 14:
|
||||||
// EPICS should already prevent this issue in the first place,
|
// EPICS should already prevent this issue in the first place,
|
||||||
// since it contains the user limits
|
// since it contains the user limits
|
||||||
if (pC_->getMsgPrintControl().shouldBePrinted(keyError, true,
|
if (pC_->getMsgPrintControl().shouldBePrinted(
|
||||||
pC_->pasynUser())) {
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
|
||||||
|
pC_->pasynUser())) {
|
||||||
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d\nMove "
|
"Controller \"%s\", axis %d => %s, line %d\nMove "
|
||||||
"command exceeds hardware limits (P%2.2d01 = %d).%s\n",
|
"command exceeds hardware limits (P%2.2d01 = %d).%s\n",
|
||||||
@@ -716,8 +727,9 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
|
|||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
|
|
||||||
if (pC_->getMsgPrintControl().shouldBePrinted(keyError, true,
|
if (pC_->getMsgPrintControl().shouldBePrinted(
|
||||||
pC_->pasynUser())) {
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
|
||||||
|
pC_->pasynUser())) {
|
||||||
asynPrint(
|
asynPrint(
|
||||||
pC_->pasynUser(), ASYN_TRACE_ERROR,
|
pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d\nUnknown error "
|
"Controller \"%s\", axis %d => %s, line %d\nUnknown error "
|
||||||
@@ -728,10 +740,6 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
|
|||||||
setAxisParamChecked(this, motorMessageText, userMessage);
|
setAxisParamChecked(this, motorMessageText, userMessage);
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (status == asynSuccess) {
|
|
||||||
pC_->getMsgPrintControl().resetCount(keyError, pC_->pasynUser());
|
|
||||||
}
|
|
||||||
return status;
|
return status;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -833,7 +841,6 @@ asynStatus turboPmacAxis::doMove(double position, int relative,
|
|||||||
|
|
||||||
asynStatus turboPmacAxis::stop(double acceleration) {
|
asynStatus turboPmacAxis::stop(double acceleration) {
|
||||||
|
|
||||||
// Status of read-write-operations of ASCII commands to the controller
|
|
||||||
asynStatus status = asynSuccess;
|
asynStatus status = asynSuccess;
|
||||||
|
|
||||||
char command[pC_->MAXBUF_] = {0};
|
char command[pC_->MAXBUF_] = {0};
|
||||||
@@ -857,6 +864,18 @@ asynStatus turboPmacAxis::stop(double acceleration) {
|
|||||||
// if we're currently inside it.
|
// if we're currently inside it.
|
||||||
pTurboPmacA_->waitForHandshake = false;
|
pTurboPmacA_->waitForHandshake = false;
|
||||||
|
|
||||||
|
/*
|
||||||
|
Stopping the motor results in a movement and further move commands have to
|
||||||
|
wait until the stopping movement is done. Therefore, we need to wait until
|
||||||
|
the poller "sees" the changed state (otherwise, we risk issuing move
|
||||||
|
commands while the motor is stopping). To ensure that at least one poll is
|
||||||
|
done, this thread (which also runs move commands) is paused for twice the
|
||||||
|
idle poll period.
|
||||||
|
*/
|
||||||
|
unsigned int idlePollMicros =
|
||||||
|
(unsigned int)ceil(pC_->idlePollPeriod() * 1e6);
|
||||||
|
usleep(2 * idlePollMicros);
|
||||||
|
|
||||||
return status;
|
return status;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -886,14 +905,8 @@ asynStatus turboPmacAxis::doReset() {
|
|||||||
// if we're currently inside it.
|
// if we're currently inside it.
|
||||||
pTurboPmacA_->waitForHandshake = false;
|
pTurboPmacA_->waitForHandshake = false;
|
||||||
|
|
||||||
// Disable the axis, if it is not in a moving state
|
// Disable the axis
|
||||||
int axStat = pTurboPmacA_->axisStatus;
|
return enable(false);
|
||||||
if (axStat == 0 || axStat == -6) {
|
|
||||||
snprintf(command, sizeof(command), "M%2.2d14=0", axisNo_);
|
|
||||||
status = pC_->writeRead(axisNo_, command, response, 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
return status;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@@ -1052,7 +1065,7 @@ asynStatus turboPmacAxis::rereadEncoder() {
|
|||||||
|
|
||||||
asynStatus turboPmacAxis::enable(bool on) {
|
asynStatus turboPmacAxis::enable(bool on) {
|
||||||
|
|
||||||
int timeout_enable_disable = 2;
|
int timeout_enable_disable = 5;
|
||||||
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;
|
||||||
@@ -1080,13 +1093,16 @@ asynStatus turboPmacAxis::enable(bool on) {
|
|||||||
axStatus == 5 || axStatus == 6 || axStatus == 7 || axStatus == 8 ||
|
axStatus == 5 || axStatus == 6 || axStatus == 7 || axStatus == 8 ||
|
||||||
axStatus == 9 || axStatus == 10 || axStatus == 11 || axStatus == 12 ||
|
axStatus == 9 || axStatus == 10 || axStatus == 11 || axStatus == 12 ||
|
||||||
axStatus == 13 || axStatus == 15 || axStatus == 16) {
|
axStatus == 13 || axStatus == 15 || axStatus == 16) {
|
||||||
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
|
||||||
"Controller \"%s\", axis %d => %s, line %d\nAxis is not "
|
asynPrint(
|
||||||
"idle and can therefore not be enabled / disabled.\n",
|
pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
|
"Controller \"%s\", axis %d => %s, line %d\nAxis is not "
|
||||||
|
"idle (status %d) and can therefore not be enabled / disabled.\n",
|
||||||
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, axStatus);
|
||||||
|
|
||||||
setAxisParamChecked(this, motorMessageText,
|
setAxisParamChecked(this, motorMessageText,
|
||||||
"Axis cannot be disabled while it is moving.");
|
"Axis cannot be disabled while it is moving.");
|
||||||
|
pTurboPmacA_->enableDisable = false;
|
||||||
return asynError;
|
return asynError;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -1109,7 +1125,10 @@ asynStatus turboPmacAxis::enable(bool on) {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// Enable / disable the axis if it is not moving
|
// Now the actual enabling / disabling starts
|
||||||
|
pTurboPmacA_->enableDisable = true;
|
||||||
|
|
||||||
|
// Enable / disable the axis
|
||||||
snprintf(command, sizeof(command), "M%2.2d14=%d", axisNo_, on);
|
snprintf(command, sizeof(command), "M%2.2d14=%d", axisNo_, 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",
|
||||||
@@ -1127,10 +1146,14 @@ asynStatus turboPmacAxis::enable(bool on) {
|
|||||||
int startTime = time(NULL);
|
int startTime = time(NULL);
|
||||||
while (time(NULL) < startTime + timeout_enable_disable) {
|
while (time(NULL) < startTime + timeout_enable_disable) {
|
||||||
|
|
||||||
|
// Wait a bit between status updates from the controller.
|
||||||
|
usleep(10000);
|
||||||
|
|
||||||
// Read the axis status
|
// Read the axis status
|
||||||
usleep(100000);
|
|
||||||
status = pC_->writeRead(axisNo_, command, response, 1);
|
status = pC_->writeRead(axisNo_, command, response, 1);
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
|
// Enabling / disabling procedure failed
|
||||||
|
pTurboPmacA_->enableDisable = false;
|
||||||
return status;
|
return status;
|
||||||
}
|
}
|
||||||
nvals = sscanf(response, "%d", &pTurboPmacA_->axisStatus);
|
nvals = sscanf(response, "%d", &pTurboPmacA_->axisStatus);
|
||||||
@@ -1140,9 +1163,13 @@ asynStatus turboPmacAxis::enable(bool on) {
|
|||||||
}
|
}
|
||||||
|
|
||||||
if ((pTurboPmacA_->axisStatus != -3) == on) {
|
if ((pTurboPmacA_->axisStatus != -3) == on) {
|
||||||
|
usleep(500000);
|
||||||
|
|
||||||
bool moving = false;
|
bool moving = false;
|
||||||
// Perform a poll to update the parameter library
|
forcedPoll(&moving);
|
||||||
poll(&moving);
|
|
||||||
|
// Enabling / disabling procedure is completed (successfully)
|
||||||
|
pTurboPmacA_->enableDisable = false;
|
||||||
return asynSuccess;
|
return asynSuccess;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -1159,6 +1186,9 @@ asynStatus turboPmacAxis::enable(bool on) {
|
|||||||
snprintf(command, sizeof(command), "Failed to %s within %d seconds",
|
snprintf(command, sizeof(command), "Failed to %s within %d seconds",
|
||||||
on ? "enable" : "disable", timeout_enable_disable);
|
on ? "enable" : "disable", timeout_enable_disable);
|
||||||
setAxisParamChecked(this, motorMessageText, command);
|
setAxisParamChecked(this, motorMessageText, command);
|
||||||
|
|
||||||
|
// Enabling / disabling procedure failed
|
||||||
|
pTurboPmacA_->enableDisable = false;
|
||||||
return asynError;
|
return asynError;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
@@ -4,9 +4,9 @@
|
|||||||
#include "turboPmacController.h"
|
#include "turboPmacController.h"
|
||||||
#include <memory>
|
#include <memory>
|
||||||
|
|
||||||
struct turboPmacAxisImpl;
|
struct HIDDEN turboPmacAxisImpl;
|
||||||
|
|
||||||
class turboPmacAxis : public sinqAxis {
|
class HIDDEN turboPmacAxis : public sinqAxis {
|
||||||
public:
|
public:
|
||||||
/**
|
/**
|
||||||
* @brief Construct a new turboPmacAxis
|
* @brief Construct a new turboPmacAxis
|
||||||
|
|||||||
@@ -41,7 +41,7 @@ struct turboPmacControllerImpl {
|
|||||||
// User for writing int32 values to the port driver.
|
// User for writing int32 values to the port driver.
|
||||||
asynUser *pasynInt32SyncIOipPort;
|
asynUser *pasynInt32SyncIOipPort;
|
||||||
|
|
||||||
// Indices of additional PVs
|
// Indices of additional ParamLib entries
|
||||||
int rereadEncoderPosition;
|
int rereadEncoderPosition;
|
||||||
int readConfig;
|
int readConfig;
|
||||||
int flushHardware;
|
int flushHardware;
|
||||||
@@ -207,7 +207,6 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
|
|||||||
// Definition of local variables.
|
// Definition of local variables.
|
||||||
asynStatus status = asynSuccess;
|
asynStatus status = asynSuccess;
|
||||||
asynStatus timeoutStatus = asynSuccess;
|
asynStatus timeoutStatus = asynSuccess;
|
||||||
// char fullCommand[MAXBUF_] = {0};
|
|
||||||
char drvMessageText[MAXBUF_] = {0};
|
char drvMessageText[MAXBUF_] = {0};
|
||||||
char modResponse[MAXBUF_] = {0};
|
char modResponse[MAXBUF_] = {0};
|
||||||
int motorStatusProblem = 0;
|
int motorStatusProblem = 0;
|
||||||
@@ -255,6 +254,22 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
|
|||||||
pasynOctetSyncIOipPort(), command, commandLength, response, MAXBUF_,
|
pasynOctetSyncIOipPort(), command, commandLength, response, MAXBUF_,
|
||||||
pTurboPmacC_->comTimeout, &nbytesOut, &nbytesIn, &eomReason);
|
pTurboPmacC_->comTimeout, &nbytesOut, &nbytesIn, &eomReason);
|
||||||
|
|
||||||
|
/*
|
||||||
|
If sth. is written to the controller, it needs some time to process the
|
||||||
|
command. However, the controller returns the acknowledgment via
|
||||||
|
pasynOctetSyncIO->writeRead immediately, signalling to the driver that it is
|
||||||
|
ready to receive the next command. In practice, this can result in commands
|
||||||
|
getting discarded on the driver side or in bringing the driver in undefined
|
||||||
|
states (e.g. stuck in status 1).
|
||||||
|
|
||||||
|
To prevent this, we wait for 20 ms after a write command to give the
|
||||||
|
controller enough time to process everything. A write command can be
|
||||||
|
identified by looking for the equal sign.
|
||||||
|
*/
|
||||||
|
if (strchr(command, '=')) {
|
||||||
|
usleep(20000);
|
||||||
|
}
|
||||||
|
|
||||||
msgPrintControlKey comKey =
|
msgPrintControlKey comKey =
|
||||||
msgPrintControlKey(portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
msgPrintControlKey(portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
|
||||||
|
|
||||||
|
|||||||
@@ -15,11 +15,11 @@
|
|||||||
// Forward declaration of the controller class to resolve the cyclic dependency
|
// Forward declaration of the controller class to resolve the cyclic dependency
|
||||||
// between the controller and the axis .h-file. See
|
// between the controller and the axis .h-file. See
|
||||||
// https://en.cppreference.com/w/cpp/language/class.
|
// https://en.cppreference.com/w/cpp/language/class.
|
||||||
class turboPmacAxis;
|
class HIDDEN turboPmacAxis;
|
||||||
|
|
||||||
struct turboPmacControllerImpl;
|
struct HIDDEN turboPmacControllerImpl;
|
||||||
|
|
||||||
class turboPmacController : public sinqController {
|
class HIDDEN turboPmacController : public sinqController {
|
||||||
public:
|
public:
|
||||||
/**
|
/**
|
||||||
* @brief Construct a new turboPmacController object. This function is meant
|
* @brief Construct a new turboPmacController object. This function is meant
|
||||||
@@ -93,7 +93,8 @@ class turboPmacController : public sinqController {
|
|||||||
* @return asynStatus
|
* @return asynStatus
|
||||||
*/
|
*/
|
||||||
asynStatus writeRead(int axisNo, const char *command, char *response,
|
asynStatus writeRead(int axisNo, const char *command, char *response,
|
||||||
int numExpectedResponses);
|
int numExpectedResponses)
|
||||||
|
__attribute__((visibility("hidden")));
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Specialized version of sinqController::couldNotParseResponse
|
* @brief Specialized version of sinqController::couldNotParseResponse
|
||||||
|
|||||||
Reference in New Issue
Block a user