Compare commits

...

10 Commits

Author SHA1 Message Date
295cd34993 Factored out error handling in a dedicated function
This makes it possible to reuse the error handling of the base axis in
derived axis types (e.g. seleneGuide driver).
2025-04-09 15:12:49 +02:00
b62a5fd699 Removed readInt32 method, since it is not needed. 2025-04-04 13:30:52 +02:00
a990da4245 Added functions to get/set motorPosition.
Changed to functions motorPosition and setMotorPosition in order to
retrieve / set motor positions from / to the paramLib.
2025-03-31 10:53:39 +02:00
83a74ce8d0 Added new sinqMotor version as minimum requirement 2025-03-19 15:04:16 +01:00
445dd44c19 Removed a doubling of functionality
ipPortUser / lowLevelPortUser are already defined in the sinqMotor
library
2025-03-10 17:02:28 +01:00
d471041c59 Removed friend class declaration and replaced access to private
properties with accessors
2025-03-10 16:55:10 +01:00
967613447b Added error reset function. 2025-03-10 14:31:15 +01:00
d6adf1ad2a Fixed a compilation bug related to sinqMotor 0.8.0 2025-03-04 09:39:32 +01:00
dfb55a1b76 Added new feature msgPrintControl from sinqMotor 0.8.0. Correspondingly,
the minimum version requirement for sinqMotor has been bumped to 0.8.0.
2025-03-04 09:29:19 +01:00
8f597550fa Fixed a bug in readInt32 and prepared the turboPmac library to serve the
detectorTower library
2025-02-26 14:08:37 +01:00
6 changed files with 634 additions and 504 deletions

View File

@ -14,7 +14,7 @@ REQUIRED+=sinqMotor
motorBase_VERSION=7.2.2 motorBase_VERSION=7.2.2
# Specify the version of sinqMotor we want to build against # Specify the version of sinqMotor we want to build against
sinqMotor_VERSION=0.7.0 sinqMotor_VERSION=0.11.0
# These headers allow to depend on this library for derived drivers. # These headers allow to depend on this library for derived drivers.
HEADERS += src/turboPmacAxis.h HEADERS += src/turboPmacAxis.h

View File

@ -1,5 +1,7 @@
# turboPmac # turboPmac
## <span style="color:red">Please read the documentation of sinqMotor first: https://git.psi.ch/sinq-epics-modules/sinqmotor</span>
## Overview ## Overview
This is a driver for the Turbo PMAC motion controller with the SINQ communication protocol. It is based on the sinqMotor shared library (https://git.psi.ch/sinq-epics-modules/sinqmotor). The header files contain detailed documentation for all public functions. The headers themselves are exported when building the library to allow other drivers to depend on this one. This is a driver for the Turbo PMAC motion controller with the SINQ communication protocol. It is based on the sinqMotor shared library (https://git.psi.ch/sinq-epics-modules/sinqmotor). The header files contain detailed documentation for all public functions. The headers themselves are exported when building the library to allow other drivers to depend on this one.
@ -17,25 +19,45 @@ The folder "utils" contains utility scripts for working with pmac motor controll
### Usage in IOC shell ### Usage in IOC shell
turboPmac exposes the following IOC shell functions (all in turboPmacController.cpp): turboPmac exports the following IOC shell functions:
- `turboPmacController`: Create a new controller object. - `turboPmacController`: Create a new controller object.
- `turboPmacAxis`: Create a new axis object. - `turboPmacAxis`: Create a new axis object.
These functions are parametrized as follows:
The full turboPmacX.cmd file looks like this:
``` ```
turboPmacController( # Define the name of the controller and the corresponding port
"$(NAME)", # Name of the MCU, e.g. mcu1. This parameter should be provided by an environment variable. epicsEnvSet("NAME","turboPmacX")
"$(ASYN_PORT)", # IP-Port of the MCU. This parameter should be provided by an environment variable. epicsEnvSet("ASYN_PORT","p$(NAME)")
8, # Maximum number of axes
0.05, # Busy poll period in seconds # Create the TCP/IP socket used to talk with the controller. The socket can be adressed from within the IOC shell via the port name
1, # Idle poll period in seconds drvAsynIPPortConfigure("$(ASYN_PORT)","172.28.101.24:1025")
0.05 # Communication timeout in seconds
); # Create the controller object with the defined name and connect it to the socket via the port name.
``` # The other parameters are as follows:
``` # 8: Maximum number of axes
turboPmacAxis( # 0.05: Busy poll period in seconds
"$(NAME)", # Name of the associated MCU, e.g. mcu1. This parameter should be provided by an environment variable. # 1: Idle poll period in seconds
1 # Index of the axis. # 1: Socket communication timeout in seconds
); turboPmacController("$(NAME)", "$(ASYN_PORT)", 8, 0.05, 1, 1);
# Define some axes for the specified MCU at the given slot (1, 2 and 5). No slot may be used twice!
turboPmacAxis("$(NAME)",1);
turboPmacAxis("$(NAME)",2);
turboPmacAxis("$(NAME)",5);
# Set the number of subsequent timeouts
setMaxSubsequentTimeouts("$(NAME)", 20);
# Configure the timeout frequency watchdog: A maximum of 10 timeouts are allowed in 300 seconds before an alarm message is sent.
setThresholdComTimeout("$(NAME)", 300, 10);
# Parametrize the EPICS record database with the substitution file named after the MCU.
epicsEnvSet("SINQDBPATH","$(sinqMotor_DB)/sinqMotor.db")
dbLoadTemplate("$(TOP)/$(NAME).substitutions", "INSTR=$(INSTR)$(NAME):,CONTROLLER=$(NAME)")
epicsEnvSet("SINQDBPATH","$(turboPmac_DB)/turboPmac.db")
dbLoadTemplate("$(TOP)/$(NAME).substitutions", "INSTR=$(INSTR)$(NAME):,CONTROLLER=$(NAME)")
dbLoadRecords("$(sinqMotor_DB)/asynRecord.db","P=$(INSTR)$(NAME),PORT=$(ASYN_PORT)")
``` ```
### Versioning ### Versioning

File diff suppressed because it is too large Load Diff

View File

@ -3,7 +3,7 @@
#include "sinqAxis.h" #include "sinqAxis.h"
// Forward declaration of the controller class to resolve the cyclic dependency // Forward declaration of the controller class to resolve the cyclic dependency
// between C804Controller.h and C804Axis.h. 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 turboPmacController; class turboPmacController;
@ -15,7 +15,8 @@ class turboPmacAxis : public sinqAxis {
* @param pController Pointer to the associated controller * @param pController Pointer to the associated controller
* @param axisNo Index of the axis * @param axisNo Index of the axis
*/ */
turboPmacAxis(turboPmacController *pController, int axisNo); turboPmacAxis(turboPmacController *pController, int axisNo,
bool initialize = true);
/** /**
* @brief Destroy the turboPmacAxis * @brief Destroy the turboPmacAxis
@ -74,12 +75,20 @@ class turboPmacAxis : public sinqAxis {
* 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 acceleration
* from the MCU and store this information in the parameter library. * 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 according to the initial status of the axis.
* *
* @return asynStatus * @return asynStatus
*/ */
asynStatus init(); asynStatus init();
/**
* @brief Implementation of the `doReset` function from sinqAxis.
*
* @param on
* @return asynStatus
*/
asynStatus doReset();
/** /**
* @brief Enable / disable the axis. * @brief Enable / disable the axis.
* *
@ -103,6 +112,16 @@ class turboPmacAxis : public sinqAxis {
*/ */
asynStatus rereadEncoder(); asynStatus rereadEncoder();
/**
* @brief Interpret the error code and populate the user message accordingly
*
* @param error
* @param userMessage
* @param sizeUserMessage
* @return asynStatus
*/
asynStatus handleError(int error, char *userMessage, int sizeUserMessage);
protected: protected:
turboPmacController *pC_; turboPmacController *pC_;
@ -111,9 +130,6 @@ class turboPmacAxis : public sinqAxis {
// The axis status is used when enabling / disabling the motor // The axis status is used when enabling / disabling the motor
int axisStatus_; int axisStatus_;
private:
friend class turboPmacController;
}; };
#endif #endif

View File

@ -29,23 +29,11 @@ void adjustResponseForPrint(char *dst, const char *src, size_t buf_length) {
} }
} }
/**
* @brief Construct a new turboPmacController::turboPmacController object
*
* @param portName See documentation of sinqController
* @param ipPortConfigName See documentation of sinqController
* @param numAxes See documentation of sinqController
* @param movingPollPeriod See documentation of sinqController
* @param idlePollPeriod See documentation of sinqController
* @param comTimeout Time after which a communication timeout error
* is declared in writeRead (in seconds)
* @param extraParams See documentation of sinqController
*/
turboPmacController::turboPmacController(const char *portName, turboPmacController::turboPmacController(const char *portName,
const char *ipPortConfigName, const char *ipPortConfigName,
int numAxes, double movingPollPeriod, int numAxes, double movingPollPeriod,
double idlePollPeriod, double idlePollPeriod,
double comTimeout) double comTimeout, int numExtraParams)
: sinqController( : sinqController(
portName, ipPortConfigName, numAxes, movingPollPeriod, idlePollPeriod, portName, ipPortConfigName, numAxes, movingPollPeriod, idlePollPeriod,
/* /*
@ -53,7 +41,7 @@ turboPmacController::turboPmacController(const char *portName,
- REREAD_ENCODER_POSITION - REREAD_ENCODER_POSITION
- READ_CONFIG - READ_CONFIG
*/ */
NUM_turboPmac_DRIVER_PARAMS) numExtraParams + NUM_turboPmac_DRIVER_PARAMS)
{ {
@ -61,27 +49,12 @@ turboPmacController::turboPmacController(const char *portName,
asynStatus status = asynSuccess; asynStatus status = asynSuccess;
// Initialization of all member variables // Initialization of all member variables
lowLevelPortUser_ = nullptr;
comTimeout_ = comTimeout; comTimeout_ = comTimeout;
// Maximum allowed number of subsequent timeouts before the user is // Maximum allowed number of subsequent timeouts before the user is
// informed. // informed.
maxSubsequentTimeouts_ = 10; maxSubsequentTimeouts_ = 10;
// =========================================================================;
/*
We try to connect to the port via the port name provided by the constructor.
If this fails, the function is terminated via exit
*/
pasynOctetSyncIO->connect(ipPortConfigName, 0, &lowLevelPortUser_, NULL);
if (status != asynSuccess || lowLevelPortUser_ == nullptr) {
errlogPrintf("Controller \"%s\" => %s, line %d\nFATAL ERROR "
"(cannot connect to MCU controller).\nTerminating IOC",
portName, __PRETTY_FUNCTION__, __LINE__);
exit(-1);
}
// ========================================================================= // =========================================================================
// Create additional parameter library entries // Create additional parameter library entries
@ -115,15 +88,15 @@ turboPmacController::turboPmacController(const char *portName,
const char *message_from_device = const char *message_from_device =
"\006"; // Hex-code for ACK (acknowledge) -> Each message from the MCU "\006"; // Hex-code for ACK (acknowledge) -> Each message from the MCU
// is terminated by this value // is terminated by this value
status = pasynOctetSyncIO->setInputEos( status = pasynOctetSyncIO->setInputEos(ipPortUser_, message_from_device,
lowLevelPortUser_, message_from_device, strlen(message_from_device)); strlen(message_from_device));
if (status != asynSuccess) { if (status != asynSuccess) {
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR, asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR,
"Controller \"%s\" => %s, line %d\nFATAL ERROR " "Controller \"%s\" => %s, line %d\nFATAL ERROR "
"(setting input EOS failed with %s).\nTerminating IOC", "(setting input EOS failed with %s).\nTerminating IOC",
portName, __PRETTY_FUNCTION__, __LINE__, portName, __PRETTY_FUNCTION__, __LINE__,
stringifyAsynStatus(status)); stringifyAsynStatus(status));
pasynOctetSyncIO->disconnect(lowLevelPortUser_); pasynOctetSyncIO->disconnect(ipPortUser_);
exit(-1); exit(-1);
} }
@ -135,7 +108,7 @@ turboPmacController::turboPmacController(const char *portName,
"with %s).\nTerminating IOC", "with %s).\nTerminating IOC",
portName, __PRETTY_FUNCTION__, __LINE__, portName, __PRETTY_FUNCTION__, __LINE__,
stringifyAsynStatus(status)); stringifyAsynStatus(status));
pasynOctetSyncIO->disconnect(lowLevelPortUser_); pasynOctetSyncIO->disconnect(ipPortUser_);
exit(-1); exit(-1);
} }
} }
@ -145,39 +118,18 @@ Access one of the axes of the controller via the axis adress stored in asynUser.
If the axis does not exist or is not a Axis, a nullptr is returned and an If the axis does not exist or is not a Axis, a nullptr is returned and an
error is emitted. error is emitted.
*/ */
turboPmacAxis *turboPmacController::getAxis(asynUser *pasynUser) { turboPmacAxis *turboPmacController::getTurboPmacAxis(asynUser *pasynUser) {
asynMotorAxis *asynAxis = asynMotorController::getAxis(pasynUser); asynMotorAxis *asynAxis = asynMotorController::getAxis(pasynUser);
return turboPmacController::castToAxis(asynAxis); return dynamic_cast<turboPmacAxis *>(asynAxis);
} }
/* /*
Access one of the axes of the controller via the axis index. Access one of the axes of the controller via the axis index.
If the axis does not exist or is not a Axis, the function must return Null If the axis does not exist or is not a Axis, the function must return Null
*/ */
turboPmacAxis *turboPmacController::getAxis(int axisNo) { turboPmacAxis *turboPmacController::getTurboPmacAxis(int axisNo) {
asynMotorAxis *asynAxis = asynMotorController::getAxis(axisNo); asynMotorAxis *asynAxis = asynMotorController::getAxis(axisNo);
return turboPmacController::castToAxis(asynAxis); return dynamic_cast<turboPmacAxis *>(asynAxis);
}
turboPmacAxis *turboPmacController::castToAxis(asynMotorAxis *asynAxis) {
// =========================================================================
// If the axis slot of the pAxes_ array is empty, a nullptr must be returned
if (asynAxis == nullptr) {
return nullptr;
}
// Here, an error is emitted since asyn_axis is not a nullptr but also not
// an instance of Axis
turboPmacAxis *axis = dynamic_cast<turboPmacAxis *>(asynAxis);
if (axis == nullptr) {
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR,
"Controller \"%s\", axis %d => %s, line %d\nAxis is not "
"an instance of turboPmacAxis",
portName, axis->axisNo_, __PRETTY_FUNCTION__, __LINE__);
}
return axis;
} }
asynStatus turboPmacController::writeRead(int axisNo, const char *command, asynStatus turboPmacController::writeRead(int axisNo, const char *command,
@ -216,7 +168,7 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
// ========================================================================= // =========================================================================
turboPmacAxis *axis = getAxis(axisNo); turboPmacAxis *axis = getTurboPmacAxis(axisNo);
if (axis == nullptr) { if (axis == nullptr) {
// We already did the error logging directly in getAxis // We already did the error logging directly in getAxis
return asynError; return asynError;
@ -273,10 +225,6 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
// +1 for the carriage return. // +1 for the carriage return.
const size_t fullComandLength = offset + commandLength + 1; const size_t fullComandLength = offset + commandLength + 1;
asynPrint(this->pasynUserSelf, ASYN_TRACEIO_DRIVER,
"Controller \"%s\", axis %d => %s, line %d\nSending command %s",
portName, axisNo, __PRETTY_FUNCTION__, __LINE__, fullCommand);
/* /*
We use separated write and read commands here, not the combined writeRead We use separated write and read commands here, not the combined writeRead
method, because the latter is actually a flushWriteRead (see method, because the latter is actually a flushWriteRead (see
@ -291,15 +239,22 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
trying to reconnect. If the problem persists, ask them to call the support trying to reconnect. If the problem persists, ask them to call the support
*/ */
status = pasynOctetSyncIO->write(lowLevelPortUser_, fullCommand, status = pasynOctetSyncIO->write(ipPortUser_, fullCommand, fullComandLength,
fullComandLength, comTimeout_, &nbytesOut); comTimeout_, &nbytesOut);
msgPrintControlKey writeKey =
msgPrintControlKey(portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
if (status == asynTimeout) { if (status == asynTimeout) {
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR, if (msgPrintControl_.shouldBePrinted(writeKey, true, pasynUserSelf)) {
"Controller \"%s\", axis %d => %s, line %d\nTimeout while " asynPrint(
"writing to the MCU\n", this->pasynUserSelf, ASYN_TRACE_ERROR,
portName, axisNo, __PRETTY_FUNCTION__, __LINE__); "Controller \"%s\", axis %d => %s, line %d\nTimeout while "
"writing to the MCU.%s\n",
portName, axisNo, __PRETTY_FUNCTION__, __LINE__,
msgPrintControl_.getSuffix());
}
timeoutStatus = checkComTimeoutWatchdog(axisNo, drvMessageText, timeoutStatus = checkComTimeoutWatchdog(axisNo, drvMessageText,
sizeof(drvMessageText)); sizeof(drvMessageText));
@ -309,7 +264,7 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
checkMaxSubsequentTimeouts(timeoutCounter, axis); checkMaxSubsequentTimeouts(timeoutCounter, axis);
timeoutCounter += 1; timeoutCounter += 1;
status = pasynOctetSyncIO->write(lowLevelPortUser_, fullCommand, status = pasynOctetSyncIO->write(ipPortUser_, fullCommand,
fullComandLength, comTimeout_, fullComandLength, comTimeout_,
&nbytesOut); &nbytesOut);
if (status != asynTimeout) { if (status != asynTimeout) {
@ -321,23 +276,35 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
} }
} }
} else if (status != asynSuccess) { } else if (status != asynSuccess) {
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR, if (msgPrintControl_.shouldBePrinted(writeKey, true, pasynUserSelf)) {
"Controller \"%s\", axis %d => %s, line %d\nError %s while " asynPrint(
"writing to the controller\n", this->pasynUserSelf, ASYN_TRACE_ERROR,
portName, axisNo, __PRETTY_FUNCTION__, __LINE__, "Controller \"%s\", axis %d => %s, line %d\nError %s while "
stringifyAsynStatus(status)); "writing to the controller.%s\n",
portName, axisNo, __PRETTY_FUNCTION__, __LINE__,
stringifyAsynStatus(status), msgPrintControl_.getSuffix());
}
} else {
msgPrintControl_.resetCount(writeKey, pasynUserSelf);
} }
// Read the response from the MCU buffer // Read the response from the MCU buffer
status = pasynOctetSyncIO->read(lowLevelPortUser_, response, MAXBUF_, status = pasynOctetSyncIO->read(ipPortUser_, response, MAXBUF_, comTimeout_,
comTimeout_, &nbytesIn, &eomReason); &nbytesIn, &eomReason);
msgPrintControlKey readKey =
msgPrintControlKey(portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
if (status == asynTimeout) { if (status == asynTimeout) {
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR, if (msgPrintControl_.shouldBePrinted(readKey, true, pasynUserSelf)) {
"Controller \"%s\", axis %d => %s, line %d\nTimeout while " asynPrint(
"reading from the MCU\n", this->pasynUserSelf, ASYN_TRACE_ERROR,
portName, axisNo, __PRETTY_FUNCTION__, __LINE__); "Controller \"%s\", axis %d => %s, line %d\nTimeout while "
"reading from the MCU.%s\n",
portName, axisNo, __PRETTY_FUNCTION__, __LINE__,
msgPrintControl_.getSuffix());
}
// Add this event to the back of the timeout event counter // Add this event to the back of the timeout event counter
timeoutStatus = checkComTimeoutWatchdog(axisNo, drvMessageText, timeoutStatus = checkComTimeoutWatchdog(axisNo, drvMessageText,
@ -348,9 +315,8 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
checkMaxSubsequentTimeouts(timeoutCounter, axis); checkMaxSubsequentTimeouts(timeoutCounter, axis);
timeoutCounter += 1; timeoutCounter += 1;
status = status = pasynOctetSyncIO->read(ipPortUser_, response, MAXBUF_,
pasynOctetSyncIO->read(lowLevelPortUser_, response, MAXBUF_, comTimeout_, &nbytesIn, &eomReason);
comTimeout_, &nbytesIn, &eomReason);
if (status != asynTimeout) { if (status != asynTimeout) {
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR, asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR,
"Controller \"%s\", axis %d => %s, line " "Controller \"%s\", axis %d => %s, line "
@ -360,11 +326,16 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
} }
} }
} else if (status != asynSuccess) { } else if (status != asynSuccess) {
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR, if (msgPrintControl_.shouldBePrinted(readKey, true, pasynUserSelf)) {
"Controller \"%s\", axis %d => %s, line %d\nError %s while " asynPrint(
"reading from the controller\n", this->pasynUserSelf, ASYN_TRACE_ERROR,
portName, axisNo, __PRETTY_FUNCTION__, __LINE__, "Controller \"%s\", axis %d => %s, line %d\nError %s while "
stringifyAsynStatus(status)); "reading from the controller.%s\n",
portName, axisNo, __PRETTY_FUNCTION__, __LINE__,
stringifyAsynStatus(status), msgPrintControl_.getSuffix());
}
} else {
msgPrintControl_.resetCount(readKey, pasynUserSelf);
} }
if (timeoutStatus == asynError) { if (timeoutStatus == asynError) {
@ -372,6 +343,8 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
} }
// The message should only ever terminate due to reason 2 // The message should only ever terminate due to reason 2
msgPrintControlKey terminateKey =
msgPrintControlKey(portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
if (eomReason != 2) { if (eomReason != 2) {
status = asynError; status = asynError;
@ -379,10 +352,16 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
"Terminated message due to reason %d (should be 2).", "Terminated message due to reason %d (should be 2).",
eomReason); eomReason);
asynPrint(this->pasynUserSelf, ASYN_TRACEIO_DRIVER, if (msgPrintControl_.shouldBePrinted(terminateKey, true,
"Controller \"%s\", axis %d => %s, line %d\nMessage " pasynUserSelf)) {
"terminated due to reason %i\n", asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR,
portName, axisNo, __PRETTY_FUNCTION__, __LINE__, eomReason); "Controller \"%s\", axis %d => %s, line %d\nMessage "
"terminated due to reason %i.%s\n",
portName, axisNo, __PRETTY_FUNCTION__, __LINE__,
eomReason, msgPrintControl_.getSuffix());
}
} else {
msgPrintControl_.resetCount(terminateKey, pasynUserSelf);
} }
/* /*
@ -394,20 +373,30 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
numReceivedResponses++; numReceivedResponses++;
} }
} }
msgPrintControlKey numResponsesKey =
msgPrintControlKey(portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
if (numExpectedResponses != numReceivedResponses) { if (numExpectedResponses != numReceivedResponses) {
adjustResponseForPrint(modResponse, response, MAXBUF_); adjustResponseForPrint(modResponse, response, MAXBUF_);
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR,
"Controller \"%s\", axis %d => %s, line %d\nUnexpected " if (msgPrintControl_.shouldBePrinted(numResponsesKey, true,
"response '%s' (carriage returns are replaced with spaces) " pasynUserSelf)) {
"for command %s\n", asynPrint(
portName, axisNo, __PRETTY_FUNCTION__, __LINE__, modResponse, this->pasynUserSelf, ASYN_TRACE_ERROR,
command); "Controller \"%s\", axis %d => %s, line %d\nUnexpected "
"response '%s' (carriage returns are replaced with spaces) "
"for command %s.%s\n",
portName, axisNo, __PRETTY_FUNCTION__, __LINE__, modResponse,
command, msgPrintControl_.getSuffix());
}
snprintf(drvMessageText, sizeof(drvMessageText), snprintf(drvMessageText, sizeof(drvMessageText),
"Received unexpected response '%s' (carriage returns " "Received unexpected response '%s' (carriage returns "
"are replaced with spaces) for command %s. " "are replaced with spaces) for command %s. "
"Please call the support", "Please call the support",
modResponse, command); modResponse, command);
status = asynError; status = asynError;
} else {
msgPrintControl_.resetCount(numResponsesKey, pasynUserSelf);
} }
// Create custom error messages for different failure modes, if no error // Create custom error messages for different failure modes, if no error
@ -437,23 +426,12 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
// Log the overall status (communication successfull or not) // Log the overall status (communication successfull or not)
if (status == asynSuccess) { if (status == asynSuccess) {
asynPrint(lowLevelPortUser_, ASYN_TRACEIO_DRIVER,
"Controller \"%s\", axis %d => %s, line %d\nDevice "
"response: %s (carriage returns are replaced with spaces)\n",
portName, axisNo, __PRETTY_FUNCTION__, __LINE__, modResponse);
paramLibStatus = axis->setIntegerParam(this->motorStatusCommsError_, 0); paramLibStatus = axis->setIntegerParam(this->motorStatusCommsError_, 0);
} else { } else {
asynPrint(lowLevelPortUser_, ASYN_TRACE_ERROR, // Check if the axis already is in an error communication mode. If
"Controller \"%s\", axis %d => %s, line %d\nCommunication " // it is not, upstream the error. This is done to avoid "flooding"
"failed for command %s (%s)\n", // the user with different error messages if more than one error
portName, axisNo, __PRETTY_FUNCTION__, __LINE__, fullCommand, // ocurred before an error-free communication
stringifyAsynStatus(status));
// Check if the axis already is in an error communication mode. If it is
// not, upstream the error. This is done to avoid "flooding" the user
// with different error messages if more than one error ocurred before
// an error-free communication
paramLibStatus = paramLibStatus =
getIntegerParam(axisNo, motorStatusProblem_, &motorStatusProblem); getIntegerParam(axisNo, motorStatusProblem_, &motorStatusProblem);
if (paramLibStatus != asynSuccess) { if (paramLibStatus != asynSuccess) {
@ -494,11 +472,7 @@ asynStatus turboPmacController::writeInt32(asynUser *pasynUser,
// ===================================================================== // =====================================================================
turboPmacAxis *axis = getAxis(pasynUser); turboPmacAxis *axis = getTurboPmacAxis(pasynUser);
if (axis == nullptr) {
// We already did the error logging directly in getAxis
return asynError;
}
// Handle custom PVs // Handle custom PVs
if (function == rereadEncoderPosition_) { if (function == rereadEncoderPosition_) {
@ -510,22 +484,14 @@ asynStatus turboPmacController::writeInt32(asynUser *pasynUser,
} }
} }
asynStatus sinqController::readInt32(asynUser *pasynUser, epicsInt32 *value) { asynStatus turboPmacController::couldNotParseResponse(const char *command,
// PMACs can be disabled const char *response,
if (pasynUser->reason == motorCanDisable_) { int axisNo,
*value = 1; const char *functionName,
return asynSuccess; int lineNumber) {
} else {
return asynMotorController::readInt32(pasynUser, value);
}
}
asynStatus turboPmacController::errMsgCouldNotParseResponse(
const char *command, const char *response, int axisNo,
const char *functionName, int lineNumber) {
char modifiedResponse[MAXBUF_] = {0}; char modifiedResponse[MAXBUF_] = {0};
adjustResponseForPrint(modifiedResponse, response, MAXBUF_); adjustResponseForPrint(modifiedResponse, response, MAXBUF_);
return sinqController::errMsgCouldNotParseResponse( return sinqController::couldNotParseResponse(
command, modifiedResponse, axisNo, functionName, lineNumber); command, modifiedResponse, axisNo, functionName, lineNumber);
} }
@ -549,8 +515,8 @@ asynStatus turboPmacCreateController(const char *portName,
https://github.com/epics-modules/motor/blob/master/motorApp/MotorSrc/asynMotorController.cpp https://github.com/epics-modules/motor/blob/master/motorApp/MotorSrc/asynMotorController.cpp
https://github.com/epics-modules/asyn/blob/master/asyn/asynPortDriver/asynPortDriver.cpp https://github.com/epics-modules/asyn/blob/master/asyn/asynPortDriver/asynPortDriver.cpp
The created object is registered in EPICS in its constructor and can safely The created object is registered in EPICS in its constructor and can
be "leaked" here. safely be "leaked" here.
*/ */
#pragma GCC diagnostic ignored "-Wunused-but-set-variable" #pragma GCC diagnostic ignored "-Wunused-but-set-variable"
#pragma GCC diagnostic ignored "-Wunused-variable" #pragma GCC diagnostic ignored "-Wunused-variable"
@ -582,17 +548,17 @@ static const iocshArg CreateControllerArg5 = {"Communication timeout (s)",
static const iocshArg *const CreateControllerArgs[] = { static const iocshArg *const CreateControllerArgs[] = {
&CreateControllerArg0, &CreateControllerArg1, &CreateControllerArg2, &CreateControllerArg0, &CreateControllerArg1, &CreateControllerArg2,
&CreateControllerArg3, &CreateControllerArg4, &CreateControllerArg5}; &CreateControllerArg3, &CreateControllerArg4, &CreateControllerArg5};
static const iocshFuncDef configturboPmacCreateController = { static const iocshFuncDef configTurboPmacCreateController = {
"turboPmacController", 6, CreateControllerArgs}; "turboPmacController", 6, CreateControllerArgs};
static void configTurboPmacCreateControllerCallFunc(const iocshArgBuf *args) { static void configTurboPmacCreateControllerCallFunc(const iocshArgBuf *args) {
turboPmacCreateController(args[0].sval, args[1].sval, args[2].ival, turboPmacCreateController(args[0].sval, args[1].sval, args[2].ival,
args[3].dval, args[4].dval, args[5].dval); args[3].dval, args[4].dval, args[5].dval);
} }
// This function is made known to EPICS in turboPmac.dbd and is called by EPICS // This function is made known to EPICS in turboPmac.dbd and is called by
// in order to register both functions in the IOC shell // EPICS in order to register both functions in the IOC shell
static void turboPmacControllerRegister(void) { static void turboPmacControllerRegister(void) {
iocshRegister(&configturboPmacCreateController, iocshRegister(&configTurboPmacCreateController,
configTurboPmacCreateControllerCallFunc); configTurboPmacCreateControllerCallFunc);
} }
epicsExportRegistrar(turboPmacControllerRegister); epicsExportRegistrar(turboPmacControllerRegister);

View File

@ -13,10 +13,10 @@
#include "turboPmacAxis.h" #include "turboPmacAxis.h"
class turboPmacController : public sinqController { class turboPmacController : public sinqController {
public: public:
/** /**
* @brief Construct a new turboPmacController object * @brief Construct a new turboPmacController object. This function is meant
to be called from a child class constructor.
* *
* @param portName See sinqController constructor * @param portName See sinqController constructor
* @param ipPortConfigName See sinqController constructor * @param ipPortConfigName See sinqController constructor
@ -26,10 +26,12 @@ class turboPmacController : public sinqController {
* @param comTimeout When trying to communicate with the device, * @param comTimeout When trying to communicate with the device,
the underlying asynOctetSyncIO interface waits for a response until this the underlying asynOctetSyncIO interface waits for a response until this
time (in seconds) has passed, then it declares a timeout. time (in seconds) has passed, then it declares a timeout.
* @param numExtraParams Number of extra parameters from a child class
*/ */
turboPmacController(const char *portName, const char *ipPortConfigName, turboPmacController(const char *portName, const char *ipPortConfigName,
int numAxes, double movingPollPeriod, int numAxes, double movingPollPeriod,
double idlePollPeriod, double comTimeout); double idlePollPeriod, double comTimeout,
int numExtraParams = 0);
/** /**
* @brief Get the axis object * @brief Get the axis object
@ -38,7 +40,7 @@ class turboPmacController : public sinqController {
* @return turboPmacAxis* If no axis could be found, this is a * @return turboPmacAxis* If no axis could be found, this is a
* nullptr * nullptr
*/ */
turboPmacAxis *getAxis(asynUser *pasynUser); turboPmacAxis *getTurboPmacAxis(asynUser *pasynUser);
/** /**
* @brief Get the axis object * @brief Get the axis object
@ -47,7 +49,7 @@ class turboPmacController : public sinqController {
* @return turboPmacAxis* If no axis could be found, this is a * @return turboPmacAxis* If no axis could be found, this is a
* nullptr * nullptr
*/ */
turboPmacAxis *getAxis(int axisNo); turboPmacAxis *getTurboPmacAxis(int axisNo);
/** /**
* @brief Overloaded function of sinqController * @brief Overloaded function of sinqController
@ -58,10 +60,7 @@ class turboPmacController : public sinqController {
* @param value New value * @param value New value
* @return asynStatus * @return asynStatus
*/ */
asynStatus writeInt32(asynUser *pasynUser, epicsInt32 value); virtual asynStatus writeInt32(asynUser *pasynUser, epicsInt32 value);
protected:
asynUser *lowLevelPortUser_;
/** /**
* @brief Send a command to the hardware and receive a response * @brief Send a command to the hardware and receive a response
@ -83,22 +82,13 @@ class turboPmacController : public sinqController {
int numExpectedResponses); int numExpectedResponses);
/** /**
* @brief Save cast of the given asynAxis pointer to a turboPmacAxis * @brief Specialized version of sinqController::couldNotParseResponse
* pointer. If the cast fails, this function returns a nullptr.
*
* @param asynAxis
* @return turboPmacAxis*
*/
turboPmacAxis *castToAxis(asynMotorAxis *asynAxis);
/**
* @brief Specialized version of sinqController::errMsgCouldNotParseResponse
* for turboPmac * for turboPmac
* *
* This is an overloaded version of * This is an overloaded version of
* sinqController::errMsgCouldNotParseResponse which calls * sinqController::couldNotParseResponse which calls
* adjustResponseForLogging on response before handing it over to * adjustResponseForLogging on response before handing it over to
* sinqController::errMsgCouldNotParseResponse. * sinqController::couldNotParseResponse.
* *
* @param command Command which led to the unparseable message * @param command Command which led to the unparseable message
* @param response Response which wasn't parseable * @param response Response which wasn't parseable
@ -109,17 +99,20 @@ class turboPmacController : public sinqController {
called. It is recommended to use a macro, e.g. __LINE__. called. It is recommended to use a macro, e.g. __LINE__.
* @return asynStatus Returns asynError. * @return asynStatus Returns asynError.
*/ */
asynStatus errMsgCouldNotParseResponse(const char *command, asynStatus couldNotParseResponse(const char *command, const char *response,
const char *response, int axisNo_, int axisNo_, const char *functionName,
const char *functionName, int lineNumber);
int lineNumber);
// Accessors for additional PVs
int rereadEncoderPosition() { return rereadEncoderPosition_; }
int readConfig() { return readConfig_; }
private:
// Set the maximum buffer size. This is an empirical value which must be // Set the maximum buffer size. This is an empirical value which must be
// large enough to avoid overflows for all commands to the device / // large enough to avoid overflows for all commands to the device /
// responses from it. // responses from it.
static const uint32_t MAXBUF_ = 200; static const uint32_t MAXBUF_ = 200;
protected:
/* /*
Timeout for the communication process in seconds Timeout for the communication process in seconds
*/ */
@ -132,8 +125,6 @@ class turboPmacController : public sinqController {
int rereadEncoderPosition_; int rereadEncoderPosition_;
int readConfig_; int readConfig_;
#define LAST_turboPmac_PARAM readConfig_ #define LAST_turboPmac_PARAM readConfig_
friend class turboPmacAxis;
}; };
#define NUM_turboPmac_DRIVER_PARAMS \ #define NUM_turboPmac_DRIVER_PARAMS \
(&LAST_turboPmac_PARAM - &FIRST_turboPmac_PARAM + 1) (&LAST_turboPmac_PARAM - &FIRST_turboPmac_PARAM + 1)