Updated to sinqMotor 1.7.0 for disconnect handlingwq!

.gitignore

@@ -0,0 +1,8 @@
+O.*
+.cvsignore
+.vscode
+src/.vscode
+utils/analyzeTcpDump/__pycache__
+utils/analyzeTcpDump/demo.pcap.json
+utils/analyzeTcpDump/demovenv
+utils/analyzeTcpDump/venv

Makefile

@@ -35,3 +35,4 @@ DBDS += sinqMotor/src/sinqMotor.dbd
 DBDS += src/turboPmac.dbd
 
 USR_CFLAGS += -Wall -Wextra -Wunused-result -Werror -fvisibility=hidden # -Wpedantic // Does not work because EPICS macros trigger warnings
+USR_CXXFLAGS += -Wall -Wextra -Wunused-result -Werror -fvisibility=hidden 

README.md

@@ -4,15 +4,26 @@
 
 ## 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://gitea.psi.ch/lin-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://gitea.psi.ch/lin-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.
 
 ## User guide
 
-This driver is a standard sinqMotor-derived which however uses a special low level IP Port driver (`pmacAsynIPPortConfigure`) instead of the standard `drvAsynIPPortConfigure`. For the general configuration, please see https://gitea.psi.ch/lin-epics-modules/sinqMotor/src/branch/main/README.md.
+This driver is a standard sinqMotor-derived which however uses a special low
+level IP Port driver (`pmacAsynIPPortConfigure`) instead of the standard
+`drvAsynIPPortConfigure`. For the general configuration, please see
+https://gitea.psi.ch/lin-epics-modules/sinqMotor/src/branch/main/README.md.
 
-The folder "utils" contains utility scripts for working with pmac motor controllers. To read their manual, run the scripts without any arguments.
+The folder "utils" contains utility scripts for working with pmac motor
-- writeRead.py: Allows sending commands to and receiving commands from a pmac controller over an ethernet connection.
+controllers. To read their manual, run the scripts without any arguments.
-- analyzeTcpDump.py: Parse the TCP communication between an IOC and a MCU and format it into a dictionary. "demo.py" shows how this data can be easily visualized for analysis.
+- writeRead.py: Allows sending commands to and receiving commands from a pmac
+controller over an ethernet connection.
+- analyzeTcpDump.py: Parse the TCP communication between an IOC and a MCU and
+format it into a dictionary. "demo.py" shows how this data can be easily
+visualized for analysis.
 
 ### IOC startup script
 
@@ -22,13 +33,15 @@ turboPmac exports the following IOC shell functions:
 
 The full turboPmacX.cmd file looks like this:
 
-```
+```bash
 # Define the name of the controller and the corresponding port
 epicsEnvSet("DRIVER_PORT","turboPmacX")
 epicsEnvSet("IP_PORT","p$(DRIVER_PORT)")
 
-# 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.
+# Create the TCP/IP socket used to talk with the controller. The socket can be
-# We do not use the standard asyn port driver here, but a PMAC-specific one which enables the usage of StreamDevices for
+# adressed from within the IOC shell via the port name.
+# We do not use the standard asyn port driver here, but a PMAC-specific one
+# which enables the usage of StreamDevices for
 # communicating with the controller directly.
 pmacAsynIPPortConfigure("$(IP_PORT)","172.28.101.24:1025")
 
@@ -48,7 +61,8 @@ turboPmacAxis("$(DRIVER_PORT)",5);
 # Set the number of subsequent timeouts 
 setMaxSubsequentTimeouts("$(DRIVER_PORT)", 20);
 
-# Configure the timeout frequency watchdog: A maximum of 10 timeouts are allowed in 300 seconds before an alarm message is sent.
+# Configure the timeout frequency watchdog: A maximum of 10 timeouts are allowed
+# in 300 seconds before an alarm message is sent.
 setThresholdComTimeout("$(DRIVER_PORT)", 300, 10);
 
 # Parametrize the EPICS record database with the substitution file named after the MCU.
@@ -61,14 +75,22 @@ dbLoadRecords("$(turboPmac_DB)/asynRecord.db","P=$(INSTR)$(DRIVER_PORT),PORT=$(I
 
 ### Additional records
 
-`turboPmac` provides a variety of additional records. See `db/turboPmac.db` for the complete list and the documentation.
+`turboPmac` provides a variety of additional records. See `db/turboPmac.db` for
+the complete list and the documentation.
 
 ## Developer guide
 
 ### Versioning
 
-Please see the documentation for the module sinqMotor: https://gitea.psi.ch/lin-epics-modules/sinqMotor/src/branch/main/README.md.
+Please see the documentation for the module sinqMotor:
+https://gitea.psi.ch/lin-epics-modules/sinqMotor/src/branch/main/README.md.
 
 ### How to build it
 
-This driver can be compiled and installed by running `make install` from the same directory where the Makefile is located. However, since it uses the git submodule sinqMotor, make sure that the correct version of the submodule repository is checked out AND the change is commited (`git status` shows no non-committed changes). Please see the section "Usage as static dependency" in https://gitea.psi.ch/lin-epics-modules/sinqMotor/src/branch/main/README.md for more details.
+This driver can be compiled and installed by running `make install` from the
+same directory where the Makefile is located. However, since it uses the git
+submodule sinqMotor, make sure that the correct version of the submodule
+repository is checked out AND the change is commited (`git status` shows no
+non-committed changes). Please see the section "Usage as static dependency" in
+https://gitea.psi.ch/lin-epics-modules/sinqMotor/src/branch/main/README.md for
+more details.

src/turboPmacAxis.cpp

@@ -143,7 +143,6 @@ asynStatus turboPmacAxis::init() {
     // Offset time for the movement watchdog caused by the air cushions in
     // milliseconds.
     int acoDelay = 0.0;
-    int axStatus = 0;
 
     // The parameter library takes some time to be initialized. Therefore we
     // wait until the status is not asynParamUndefined anymore.
@@ -177,27 +176,41 @@ asynStatus turboPmacAxis::init() {
     Ixx65.
     */
     snprintf(command, sizeof(command),
-             "P%2.2d00 Q%2.2d10 Q%2.2d03 Q%2.2d04 Q%2.2d06 P%2.2d22 Q%2.2d00 "
+             "Q%2.2d10 Q%2.2d03 Q%2.2d04 Q%2.2d06 P%2.2d22 Q%2.2d00 I%2.2d65",
-             "I%2.2d65",
+             axisNo_, axisNo_, axisNo_, axisNo_, axisNo_, axisNo_, axisNo_);
-             axisNo_, axisNo_, axisNo_, axisNo_, axisNo_, axisNo_, axisNo_,
+    status = pC_->writeRead(axisNo_, command, response, 7);
-             axisNo_);
+
-    status = pC_->writeRead(axisNo_, command, response, 8);
+    msgPrintControlKey keyDisconnected = msgPrintControlKey(
+        pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, 1);
+
     if (status != asynSuccess) {
+        if (pC_->getMsgPrintControl().shouldBePrinted(keyDisconnected, true,
+                                                      pC_->pasynUser())) {
             asynPrint(
                 pC_->pasynUser(), ASYN_TRACE_ERROR,
-            "Controller \"%s\", axis %d => %s, line %d\nCould not communicate "
+                "Controller \"%s\", axis %d => %s, line %d\nCould not "
-            "with controller during IOC initialization. Check if you used "
+                "communicate with controller during IOC initialization (error "
-            "\"pmacAsynIPPortConfigure\" instead of the standard "
+                "%s). Did you use \"drvAsynIPPortConfigure\" instead of "
-            "\"drvAsynIPPortConfigure\" function in the .cmd file in order to "
+                "\"pmacAsynIPPortConfigure\" in the .cmd file to create the "
-            "create the port driver.\n",
+                "port driver?\n",
-            pC_->portName, axisNo(), __PRETTY_FUNCTION__, __LINE__);
+                pC_->portName, axisNo(), __PRETTY_FUNCTION__, __LINE__,
-        pTurboPmacA_->needInit = true;
+                pC_->stringifyAsynStatus(status));
+        }
+        pTurboPmacA_->needInit = true;
+        return status;
     }
-    nvals = sscanf(response, "%d %lf %lf %lf %lf %d %lf %lf", &axStatus,
-                   &motorPos, &motorVmax, &motorVelocity, &motorAccel,
-                   &acoDelay, &counts_to_eu, &deadband_counts);
 
-    // The acoDelay is given in milliseconds -> Convert to seconds, rounded up
+    // No error has been detected -> Reset the error count
+    if (status == asynSuccess) {
+        pC_->getMsgPrintControl().resetCount(keyDisconnected, pC_->pasynUser());
+    }
+
+    nvals = sscanf(response, "%lf %lf %lf %lf %d %lf %lf", &motorPos,
+                   &motorVmax, &motorVelocity, &motorAccel, &acoDelay,
+                   &counts_to_eu, &deadband_counts);
+
+    // The acoDelay is given in milliseconds -> Convert to seconds, rounded
+    // up
     setOffsetMovTimeout(std::ceil(acoDelay / 1000.0));
 
     // The PMAC electronic specifies the acceleration in m/s^2. Since we
@@ -230,18 +243,18 @@ asynStatus turboPmacAxis::init() {
     }
 
     /*
-    Check if the new target position is within the range current position +/-
+    Check if the new target position is within the range current position
-    deadband. If that is the case, no movement command should be sent. This
+    +/- deadband. If that is the case, no movement command should be sent.
-    functionality is implemented within the motor record itself, we just need to
+    This functionality is implemented within the motor record itself, we
-    populate the field SPDP (see record PushSPDB2Field in db/turboPmac.db)
+    just need to populate the field SPDP (see record PushSPDB2Field in
+    db/turboPmac.db)
 
     First, the deadband is read out (Ixx65, see Turbo PMAC User Manual, p.
-    160). This value then needs to be converted into counts (by dividing it by
+    160). This value then needs to be converted into counts (by dividing it
-    16). After words, the deadband in counts then need to be converted into
+    by 16). After words, the deadband in counts then need to be converted
-    engineering units. For this, the scaling factor Qxx10 needs to be applied
+    into engineering units. For this, the scaling factor Qxx10 needs to be
-    (see SINQ_2G_MCU_SW_manual_rev7, p. 17):
+    applied (see SINQ_2G_MCU_SW_manual_rev7, p. 17): [Qxx10] = engineering
-    [Qxx10] = engineering units (eu) / counts
+    units (eu) / counts deadband_eu = Qxx10 * Ixx65 / 16
-    deadband_eu = Qxx10 * Ixx65 / 16
 
     The values of Qxx10 and Ixx65 are read out during initialization and are
     assumed to not change during operation.
@@ -252,11 +265,12 @@ asynStatus turboPmacAxis::init() {
     // Update the parameter library immediately
     status = callParamCallbacks();
     if (status != asynSuccess) {
-        // If we can't communicate with the parameter library, it doesn't make
+        // If we can't communicate with the parameter library, it doesn't
-        // sense to try and upstream this to the user -> Just log the error
+        // make sense to try and upstream this to the user -> Just log the
-        asynPrint(
+        // error
-            pC_->pasynUser(), ASYN_TRACE_ERROR,
+        asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
-            "Controller \"%s\", axis %d  => %s, line %d\ncallParamCallbacks "
+                  "Controller \"%s\", axis %d  => %s, line "
+                  "%d\ncallParamCallbacks "
                   "failed with %s.\n",
                   pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
                   pC_->stringifyAsynStatus(status));
@@ -344,13 +358,13 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
         }
 
         if (error != 0) {
-            // If an error occurred while waiting for the handshake, abort the
+            // If an error occurred while waiting for the handshake, abort
-            // waiting procedure and continue with the poll in order to handle
+            // the waiting procedure and continue with the poll in order to
-            // the error.
+            // handle the error.
             pTurboPmacA_->waitForHandshake = false;
         } else if (handshakePerformed == 1) {
-            // Handshake has been performed successfully -> Continue with the
+            // Handshake has been performed successfully -> Continue with
-            // poll
+            // the poll
             pTurboPmacA_->waitForHandshake = false;
         } else {
             // Still waiting for the handshake - try again in the next busy
@@ -390,15 +404,16 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
 
     /*
     The axis limits are set as: ({[]})
-    where [] are the positive and negative limits set in EPICS/NICOS, {} are the
+    where [] are the positive and negative limits set in EPICS/NICOS, {} are
-    software limits set on the MCU and () are the hardware limit switches. In
+    the software limits set on the MCU and () are the hardware limit
-    other words, the EPICS/NICOS limits should be stricter than the software
+    switches. In other words, the EPICS/NICOS limits should be stricter than
-    limits on the MCU which in turn should be stricter than the hardware limit
+    the software limits on the MCU which in turn should be stricter than the
-    switches. For example, if the hardware limit switches are at [-10, 10], the
+    hardware limit switches. For example, if the hardware limit switches are
-    software limits could be at [-9, 9] and the EPICS / NICOS limits could be at
+    at [-10, 10], the software limits could be at [-9, 9] and the EPICS /
+    NICOS limits could be at
     [-8, 8]. Therefore, we cannot use the software limits read from the MCU
-    directly, but need to shrink them a bit. In this case, we're shrinking them
+    directly, but need to shrink them a bit. In this case, we're shrinking
-    by limitsOffset on both sides.
+    them by limitsOffset on both sides.
     */
     getAxisParamChecked(this, motorLimitsOffset, &limitsOffset);
     highLimit = highLimit - limitsOffset;
@@ -414,8 +429,8 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
                             (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
-    // the shouldBePrinted calls.
+    // later in the shouldBePrinted calls.
     msgPrintControlKey keyStatus = msgPrintControlKey(
         pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
     bool resetCountStatus = true;
@@ -436,9 +451,9 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
 
         if (pC_->getMsgPrintControl().shouldBePrinted(keyStatus, true,
                                                       pC_->pasynUser())) {
-            asynPrint(
+            asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
-                pC_->pasynUser(), ASYN_TRACE_ERROR,
+                      "Controller \"%s\", axis %d  => %s, line "
-                "Controller \"%s\", axis %d  => %s, line %d\nEmergency stop "
+                      "%d\nEmergency stop "
                       "activated.%s\n",
                       pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
                       pC_->getMsgPrintControl().getSuffix());
@@ -511,8 +526,8 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
         *moving = false;
         break;
     case 15:
-        // Move is interrupted, but the motor is not ready to receive another
+        // Move is interrupted, but the motor is not ready to receive
-        // move command. Therefore it is treated as still moving.
+        // another move command. Therefore it is treated as still moving.
         *moving = true;
         break;
     case 16:
@@ -555,11 +570,6 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
 
     errorStatus = handleError(error, userMessage, sizeof(userMessage));
 
-    // Update the parameter library
-    if (error != 0) {
-        setAxisParamChecked(this, motorStatusProblem, true);
-    }
-
     if (*moving == false) {
         setAxisParamChecked(this, motorMoveToHome, false);
     }
@@ -612,11 +622,11 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
         if (pC_->getMsgPrintControl().shouldBePrinted(
                 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 "
                       "still moving, but received another move command. EPICS "
-                "should prevent this, check if *moving is set correctly.%s\n",
+                      "should prevent this, check if *moving is set "
+                      "correctly.%s\n",
                       pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
                       pC_->getMsgPrintControl().getSuffix());
         }
@@ -628,14 +638,17 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
         if (pC_->getMsgPrintControl().shouldBePrinted(
                 pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
                 pC_->pasynUser())) {
-            asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
+            asynPrint(
-                      "Controller \"%s\", axis %d  => %s, line %d\nAir cushion "
+                pC_->pasynUser(), ASYN_TRACE_ERROR,
-                      "feedback stopped during movement (P%2.2d01 = %d).%s\n",
+                "Controller \"%s\", axis %d  => %s, line %d\nLost feedback "
-                      pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
+                "from auxiliary device during movement (P%2.2d01 = "
-                      axisNo_, error, pC_->getMsgPrintControl().getSuffix());
+                "%d).%s\n",
+                pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, axisNo_,
+                error, pC_->getMsgPrintControl().getSuffix());
         }
         snprintf(userMessage, sizeUserMessage,
-                 "Air cushion feedback stopped during movement (P%2.2d01 = "
+                 "Lost feedback from auxiliary device during movement "
+                 "(P%2.2d01 = "
                  "%d). Please call the support.",
                  axisNo_, error);
         setAxisParamChecked(this, motorMessageText, userMessage);
@@ -644,26 +657,27 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
         if (pC_->getMsgPrintControl().shouldBePrinted(
                 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 feedback "
-                "Controller \"%s\", axis %d  => %s, line %d\nNo air cushion "
+                      "from "
-                "feedback before movement start (P%2.2d01 = %d).%s\n",
+                      "auxiliary device before movement (P%2.2d01 = %d).%s\n",
-                pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, axisNo_,
+                      pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
-                error, pC_->getMsgPrintControl().getSuffix());
+                      axisNo_, error, pC_->getMsgPrintControl().getSuffix());
         }
 
-        snprintf(userMessage, sizeUserMessage,
+        snprintf(
-                 "No air cushion feedback before movement start (P%2.2d01 = "
+            userMessage, sizeUserMessage,
+            "No feedback from auxiliary device before movement (P%2.2d01 = "
             "%d). Please call the support.",
             axisNo_, error);
         setAxisParamChecked(this, motorMessageText, userMessage);
         break;
     case 10:
         /*
-        Software limits of the controller have been hit. Since the EPICS limits
+        Software limits of the controller have been hit. Since the EPICS
-        are derived from the software limits and are a little bit smaller, this
+        limits are derived from the software limits and are a little bit
-        error case can only happen if either the axis has an incremental encoder
+        smaller, this error case can only happen if either the axis has an
-        which is not properly homed or if a bug occured.
+        incremental encoder which is not properly homed or if a bug occured.
         */
 
         if (pC_->getMsgPrintControl().shouldBePrinted(
@@ -690,9 +704,9 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
         if (pC_->getMsgPrintControl().shouldBePrinted(
                 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 "
-                "Controller \"%s\", axis %d  => %s, line %d\nMaximum allowed "
+                      "allowed "
                       "following error exceeded.%s\n",
                       pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
                       pC_->getMsgPrintControl().getSuffix());
@@ -735,9 +749,9 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
                       pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
                       pC_->getMsgPrintControl().getSuffix());
         }
-        snprintf(
+        snprintf(userMessage, sizeUserMessage,
-            userMessage, sizeUserMessage,
+                 "Driver hardware error (P%2.2d01 = 13). Please call the "
-            "Driver hardware error (P%2.2d01 = 13). Please call the support.",
+                 "support.",
                  axisNo_);
         setAxisParamChecked(this, motorMessageText, userMessage);
         break;
@@ -795,13 +809,17 @@ asynStatus turboPmacAxis::doMove(double position, int relative,
 
     // =========================================================================
 
+    // Suppress unused variables warning
+    (void)minVelocity;
+    (void)acceleration;
+
     getAxisParamChecked(this, motorEnableRBV, &enabled);
     getAxisParamChecked(this, motorRecResolution, &motorRecResolution);
 
     if (enabled == 0) {
-        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 disabled.\n",
+                  "disabled.\n",
                   pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
         return asynSuccess;
     }
@@ -820,8 +838,8 @@ asynStatus turboPmacAxis::doMove(double position, int relative,
     getAxisParamChecked(this, motorCanSetSpeed, &motorCanSetSpeed);
 
     // Prepend the new motor speed, if the user is allowed to set the speed.
-    // Mind the " " (space) before the closing "", as the command created here
+    // Mind the " " (space) before the closing "", as the command created
-    // is prepended to the one down below.
+    // here is prepended to the one down below.
     if (motorCanSetSpeed != 0) {
         snprintf(command, sizeof(command), "Q%2.2d04=%lf ", axisNo_,
                  motorVelocity);
@@ -834,8 +852,8 @@ asynStatus turboPmacAxis::doMove(double position, int relative,
                   motorVelocity);
     }
 
-    // Perform handshake, Set target position (and speed, if allowed) and start
+    // Perform handshake, Set target position (and speed, if allowed) and
-    // the move command
+    // start the move command
     if (relative) {
         snprintf(&command[writeOffset], sizeof(command) - writeOffset,
                  "P%2.2d23=0 Q%2.2d02=%lf M%2.2d=2", axisNo_, axisNo_,
@@ -850,9 +868,9 @@ asynStatus turboPmacAxis::doMove(double position, int relative,
     status = pC_->writeRead(axisNo_, command, response, 0);
     if (status != asynSuccess) {
 
-        asynPrint(
+        asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
-            pC_->pasynUser(), ASYN_TRACE_ERROR,
+                  "Controller \"%s\", axis %d  => %s, line %d\nStarting "
-            "Controller \"%s\", axis %d  => %s, line %d\nStarting movement to "
+                  "movement to "
                   "target position %lf failed.\n",
                   pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
                   motorTargetPosition);
@@ -860,8 +878,8 @@ asynStatus turboPmacAxis::doMove(double position, int relative,
         return 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
-    // reasonable time
+    // in a reasonable time
     pTurboPmacA_->waitForHandshake = true;
     pTurboPmacA_->timeAtHandshake = time(NULL);
 
@@ -883,29 +901,32 @@ asynStatus turboPmacAxis::stop(double acceleration) {
 
     // =========================================================================
 
+    // Suppress unused variables warning
+    (void)acceleration;
+
     snprintf(command, sizeof(command), "M%2.2d=8", axisNo_);
     status = pC_->writeRead(axisNo_, command, response, 0);
 
     if (status != asynSuccess) {
-        asynPrint(
+        asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
-            pC_->pasynUser(), ASYN_TRACE_ERROR,
+                  "Controller \"%s\", axis %d  => %s, line %d\nStopping "
-            "Controller \"%s\", axis %d  => %s, line %d\nStopping the movement "
+                  "the movement "
                   "failed.\n",
                   pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
         setAxisParamChecked(this, motorStatusProblem, true);
     }
 
-    // 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
-    // if we're currently inside it.
+    // loop, if we're currently inside it.
     pTurboPmacA_->waitForHandshake = false;
 
     /*
-    Stopping the motor results in a movement and further move commands have to
+    Stopping the motor results in a movement and further move commands have
-    wait until the stopping movement is done. Therefore, we need to wait until
+    to wait until the stopping movement is done. Therefore, we need to wait
-    the poller "sees" the changed state (otherwise, we risk issuing move
+    until the poller "sees" the changed state (otherwise, we risk issuing
-    commands while the motor is stopping). To ensure that at least one poll is
+    move commands while the motor is stopping). To ensure that at least one
-    done, this thread (which also runs move commands) is paused for twice the
+    poll is done, this thread (which also runs move commands) is paused for
-    idle poll period.
+    twice the idle poll period.
     */
     unsigned int idlePollMicros =
         (unsigned int)ceil(pC_->idlePollPeriod() * 1e6);
@@ -936,8 +957,8 @@ asynStatus turboPmacAxis::doReset() {
         setAxisParamChecked(this, motorStatusProblem, true);
     }
 
-    // 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
-    // if we're currently inside it.
+    // loop, if we're currently inside it.
     pTurboPmacA_->waitForHandshake = false;
 
     // Disable the axis
@@ -947,7 +968,7 @@ asynStatus turboPmacAxis::doReset() {
 /*
 Home the axis. On absolute encoder systems, this is a no-op
 */
-asynStatus turboPmacAxis::doHome(double min_velocity, double max_velocity,
+asynStatus turboPmacAxis::doHome(double minVelocity, double maxVelocity,
                                  double acceleration, int forwards) {
 
     // Status of read-write-operations of ASCII commands to the controller
@@ -958,6 +979,12 @@ asynStatus turboPmacAxis::doHome(double min_velocity, double max_velocity,
 
     // =========================================================================
 
+    // Suppress unused variables warning
+    (void)minVelocity;
+    (void)maxVelocity;
+    (void)acceleration;
+    (void)forwards;
+
     getAxisParamChecked(this, encoderType, &response);
 
     // Only send the home command if the axis has an incremental encoder
@@ -1029,13 +1056,14 @@ asynStatus turboPmacAxis::readEncoderType() {
 }
 
 /*
-This is not a command that can always be run when enabling a motor as it also
+This is not a command that can always be run when enabling a motor as it
-causes relative encoders to reread a position necessitating recalibration. We
+also causes relative encoders to reread a position necessitating
-only want it to run on absolute encoders. We also want it to be clear to
+recalibration. We only want it to run on absolute encoders. We also want it
-instrument scientists, that power has to be cut to the motor, in order to reread
+to be clear to instrument scientists, that power has to be cut to the motor,
-the encoder as not all motors have breaks and they may start to move when
+in order to reread the encoder as not all motors have breaks and they may
-disabled. For that reason, we don't automatically disable the motors to run the
+start to move when disabled. For that reason, we don't automatically disable
-command and instead require that the scientists first disable the motor.
+the motors to run the command and instead require that the scientists first
+disable the motor.
 */
 asynStatus turboPmacAxis::rereadEncoder() {
     char command[pC_->MAXBUF_] = {0};
@@ -1079,11 +1107,12 @@ asynStatus turboPmacAxis::rereadEncoder() {
         return asynError;
     } else {
         snprintf(command, sizeof(command), "M%2.2d=15", axisNo_);
-        asynPrint(
+        asynPrint(pC_->pasynUser(), ASYN_TRACE_FLOW,
-            pC_->pasynUser(), ASYN_TRACE_FLOW,
+                  "Controller \"%s\", axis %d  => %s, line %d\nRereading "
-            "Controller \"%s\", axis %d  => %s, line %d\nRereading absolute "
+                  "absolute "
                   "encoder via command %s.\n",
-            pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, command);
+                  pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
+                  command);
         pC_->writeRead(axisNo_, command, response, 0);
     }
 
@@ -1092,8 +1121,8 @@ asynStatus turboPmacAxis::rereadEncoder() {
     // it is actually finished, so we instead wait for 0.5 seconds.
     usleep(500000);
 
-    // Turn off parameter as finished rereading, this will only be immediately
+    // Turn off parameter as finished rereading, this will only be
-    // noticed in the read back variable though
+    // immediately noticed in the read back variable though
     setAxisParamChecked(this, rereadEncoderPosition, false);
     return asynSuccess;
 }
@@ -1113,27 +1142,28 @@ asynStatus turboPmacAxis::enable(bool on) {
     /*
     Continue regardless of the status returned by the poll; we just want to
     find out whether the motor is currently moving or not. If the poll
-    function fails before it can determine that, it is assumed that the motor
+    function fails before it can determine that, it is assumed that the
-    is not moving.
+    motor is not moving.
     */
     bool moving = false;
     doPoll(&moving);
 
     // If the axis is currently moving, it cannot be disabled. Ignore the
-    // command and inform the user. We check the last known status of the axis
+    // command and inform the user. We check the last known status of the
-    // instead of "moving", since status -6 is also moving, but the motor can
+    // axis instead of "moving", since status -6 is also moving, but the
-    // actually be disabled in this state!
+    // motor can actually be disabled in this state!
     int axStatus = pTurboPmacA_->axisStatus;
     if (axStatus == 1 || axStatus == 2 || axStatus == 3 || axStatus == 4 ||
         axStatus == 5 || axStatus == 6 || axStatus == 7 || axStatus == 8 ||
         axStatus == 9 || axStatus == 10 || axStatus == 11 || axStatus == 12 ||
         axStatus == 13 || axStatus == 15 || axStatus == 16) {
 
-        asynPrint(
+        asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
-            pC_->pasynUser(), ASYN_TRACE_ERROR,
                   "Controller \"%s\", axis %d  => %s, line %d\nAxis is not "
-            "idle (status %d) and can therefore not be enabled / disabled.\n",
+                  "idle (status %d) and can therefore not be enabled / "
-            pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, axStatus);
+                  "disabled.\n",
+                  pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
+                  axStatus);
 
         setAxisParamChecked(this, motorMessageText,
                             "Axis cannot be disabled while it is moving.");
@@ -1144,9 +1174,9 @@ asynStatus turboPmacAxis::enable(bool on) {
     // Axis is already enabled / disabled and a new enable / disable command
     // was sent => Do nothing
     if ((axStatus != -3) == on) {
-        asynPrint(
+        asynPrint(pC_->pasynUser(), ASYN_TRACE_WARNING,
-            pC_->pasynUser(), ASYN_TRACE_WARNING,
+                  "Controller \"%s\", axis %d  => %s, line %d\nAxis is "
-            "Controller \"%s\", axis %d  => %s, line %d\nAxis is already %s.\n",
+                  "already %s.\n",
                   pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
                   on ? "enabled" : "disabled");
         return asynSuccess;
@@ -1297,8 +1327,8 @@ asynStatus turboPmacCreateAxis(const char *portName, int axis) {
     https://github.com/epics-modules/motor/blob/master/motorApp/MotorSrc/asynMotorController.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-variable"
@@ -1321,14 +1351,15 @@ static const iocshArg *const CreateAxisArgs[] = {&CreateAxisArg0,
 static const iocshFuncDef configTurboPmacCreateAxis = {
     "turboPmacAxis", 2, CreateAxisArgs,
     "Create an instance of a turboPmac axis. The first argument is the "
-    "controller this axis should be attached to, the second argument is the "
+    "controller this axis should be attached to, the second argument is "
+    "the "
     "axis number."};
 static void configTurboPmacCreateAxisCallFunc(const iocshArgBuf *args) {
     turboPmacCreateAxis(args[0].sval, args[1].ival);
 }
 
-// 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 turboPmacAxisRegister(void) {
     iocshRegister(&configTurboPmacCreateAxis,
                   configTurboPmacCreateAxisCallFunc);

src/turboPmacAxis.h

@@ -13,6 +13,10 @@ class HIDDEN turboPmacAxis : public sinqAxis {
      *
      * @param pController         Pointer to the associated controller
      * @param axisNo              Index of the axis
+     * @param initialize          By setting this parameter to false, the
+     * initialization functions of the axes are not executed. This is e.g.
+     * necessary when this constructor is called from a children class
+     * constructor which performs its own initialization.
      */
     turboPmacAxis(turboPmacController *pController, int axisNo,
                   bool initialize = true);
@@ -24,6 +28,18 @@ class HIDDEN turboPmacAxis : public sinqAxis {
      */
     virtual ~turboPmacAxis();
 
+    /**
+     * @brief Readout of some values from the controller at IOC startup
+     *
+     * The following steps are performed:
+     * - Read out the motor status, motor position, velocity and acceleration
+     * from the MCU and store this information in the parameter library.
+     * - Set the enable PV according to the initial status of the axis.
+     *
+     * @return asynStatus
+     */
+    virtual asynStatus init();
+
     /**
      * @brief Implementation of the `stop` function from asynMotorAxis
      *
@@ -70,18 +86,6 @@ class HIDDEN turboPmacAxis : public sinqAxis {
                               double min_velocity, double max_velocity,
                               double acceleration);
 
-    /**
-     * @brief Readout of some values from the controller at IOC startup
-     *
-     * The following steps are performed:
-     * - Read out the motor status, motor position, velocity and acceleration
-     * from the MCU and store this information in the parameter library.
-     * - Set the enable PV according to the initial status of the axis.
-     *
-     * @return asynStatus
-     */
-    virtual asynStatus init();
-
     /**
      * @brief Implementation of the `doReset` function from sinqAxis.
      *

src/turboPmacController.cpp

@@ -61,17 +61,17 @@ turboPmacController::turboPmacController(const char *portName,
           - REREAD_ENCODER_POSITION
           - READ_CONFIG
           */
-          numExtraParams + NUM_turboPmac_DRIVER_PARAMS)
+          numExtraParams + NUM_turboPmac_DRIVER_PARAMS),
-
+      pTurboPmacC_(
-{
-
-    // The paramLib indices are populated with the calls to createParam
-    pTurboPmacC_ =
           std::make_unique<turboPmacControllerImpl>((turboPmacControllerImpl){
               .comTimeout = comTimeout,
               .lastResponse = {0},
-        });
+              .pasynInt32SyncIOipPort = nullptr, // Populated in constructor
-
+              .rereadEncoderPosition = 0,        // Populated in constructor
+              .readConfig = 0,                   // Populated in constructor
+              .flushHardware = 0,                // Populated in constructor
+              .limFromHardware = 0,              // Populated in constructor
+          })) {
     // Initialization of local variables
     asynStatus status = asynSuccess;
 
@@ -206,7 +206,6 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
 
     // Definition of local variables.
     asynStatus status = asynSuccess;
-    asynStatus timeoutStatus = asynSuccess;
     char drvMessageText[MAXBUF_] = {0};
     char modResponse[MAXBUF_] = {0};
     int motorStatusProblem = 0;
@@ -284,8 +283,7 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
                 getMsgPrintControl().getSuffix());
         }
 
-        timeoutStatus = checkComTimeoutWatchdog(axisNo, drvMessageText,
+        checkComTimeoutWatchdog(axisNo, drvMessageText, sizeof(drvMessageText));
-                                                sizeof(drvMessageText));
 
         int timeoutCounter = 0;
         while (1) {
@@ -333,14 +331,10 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
         axis->setNeedInit(true);
     }
 
-    if (timeoutStatus == asynError) {
-        status = asynError;
-    }
-
     // The message should only ever terminate due to reason 2
     msgPrintControlKey terminateKey =
         msgPrintControlKey(portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
-    if (eomReason != 2) {
+    if (status == asynSuccess && eomReason != 2) {
         status = asynError;
 
         char reasonStringified[30] = {0};
@@ -391,7 +385,7 @@ asynStatus turboPmacController::writeRead(int axisNo, const char *command,
     }
     msgPrintControlKey numResponsesKey =
         msgPrintControlKey(portName, axisNo, __PRETTY_FUNCTION__, __LINE__);
-    if (numExpectedResponses != numReceivedResponses) {
+    if (status == asynSuccess && numExpectedResponses != numReceivedResponses) {
         adjustResponseForPrint(modResponse, response, MAXBUF_);
 
         if (getMsgPrintControl().shouldBePrinted(numResponsesKey, true,
@@ -573,7 +567,8 @@ static const iocshArg *const CreateControllerArgs[] = {
     &CreateControllerArg0, &CreateControllerArg1, &CreateControllerArg2,
     &CreateControllerArg3, &CreateControllerArg4, &CreateControllerArg5};
 static const iocshFuncDef configTurboPmacCreateController = {
-    "turboPmacController", 6, CreateControllerArgs};
+    "turboPmacController", 6, CreateControllerArgs,
+    "Create a new instance of a TurboPMAC controller."};
 static void configTurboPmacCreateControllerCallFunc(const iocshArgBuf *args) {
     turboPmacCreateController(args[0].sval, args[1].sval, args[2].ival,
                               args[3].dval, args[4].dval, args[5].dval);