Compare commits

..

67 Commits
1.5.1 ... 1.6.1

Author SHA1 Message Date
76cc48a49c Reverted back to sinqMotor 1.5.7
Some checks failed
Test And Build / Lint (push) Failing after 4s
Test And Build / Build (push) Failing after 7s
2026-02-03 13:44:21 +01:00
a9f623ba1d Merge pull request 'Document how to do reset when having HW error' (#1) from fix_hw_error_doc into main
Some checks failed
Test And Build / Lint (push) Failing after 3s
Test And Build / Build (push) Failing after 7s
Reviewed-on: #1
2026-02-03 10:07:56 +01:00
791e74f82f Expanded a bit more on the FAQ
Some checks failed
Test And Build / Lint (push) Failing after 3s
Test And Build / Build (push) Failing after 7s
2026-02-03 10:02:54 +01:00
2dc10fe869 Document how to do reset when having HW error
Some checks failed
Test And Build / Lint (push) Failing after 3s
Test And Build / Build (push) Failing after 7s
2026-02-03 09:49:36 +01:00
e10aaf978e Removed unneccessary paramLib callback which caused flickering
Some checks failed
Test And Build / Lint (push) Failing after 3s
Test And Build / Build (push) Failing after 7s
2026-01-23 13:21:43 +01:00
4159ef50bc Updated to correct version of sinqMotor 2026-01-23 11:57:40 +01:00
d168453329 Removed reference in gitmodules
Some checks failed
Test And Build / Lint (push) Failing after 3s
Test And Build / Build (push) Failing after 3s
2026-01-23 11:55:34 +01:00
1ea1bd8db0 Remove sinqMotor submodule completely
Some checks failed
Test And Build / Lint (push) Failing after 3s
Test And Build / Build (push) Failing after 3s
2026-01-23 11:53:15 +01:00
a6979d303b moved disconnect handling to sinqMotor 2026-01-22 09:47:36 +01:00
78810c3364 Fixed error messages 2026-01-09 13:46:14 +01:00
21c9adec35 Update src/turboPmacAxis.cpp 2026-01-09 13:20:29 +01:00
01a0239dfb Added compiler flags for the C++ code and formatted README 2025-12-23 13:27:14 +01:00
0e2b5f5e93 Fixed number of commands bug in turboPmacAxis::init 2025-12-23 11:59:09 +01:00
50aa44014b Added user manual and .gitignore to repo 2025-11-03 08:37:49 +01:00
6d00209e8a Fixed some small bugs 2025-10-13 16:57:30 +02:00
a70bcc0d75 Fixed bug: Wrong scale used before
The correct scale from counts to engeering units is Qxx00.
2025-09-10 11:52:51 +02:00
bf3406be1c Updated to sinqMotor 1.5 to get deadband feature 2025-09-09 16:52:19 +02:00
91e2519832 Deadband check in driver code 2025-09-09 13:43:11 +02:00
829665c078 Removed C++ only flag from USR_CFLAGS
USR_CFLAGS only applies to .c files, which are compiled with a C
compiler, therefore the C++ flag is not applied, resulting in a warning
during compilation.
2025-08-22 15:27:28 +02:00
4fd95743c4 Fixed bug with errorprint to ioc console
The previous setup created one print key for all error types. The
problem with that is that if an error directly followed another error
(without an error = 0 in between), the MsgPrintControl prevented
printing of the new error. Now every error has its own key.
2025-08-22 15:25:31 +02:00
5845d2e908 Fixed imprecise comment 2025-08-12 15:42:43 +02:00
501b240250 Updated to sinqMotor 1.4.0 2025-08-12 09:14:38 +02:00
5f35c2277d Hide visibility of classes to avoid symbol clashes 2025-08-12 09:00:42 +02:00
4f972fd53d Hide symbols via compilerflag 2025-08-11 16:46:22 +02:00
2fc2ad1970 Added flag to see whether we are in the middle of enabling / disabling 2025-08-11 15:47:27 +02:00
3f7998eb9a Added sleep after write commands
See comment in writeRead for explanation.
2025-08-11 15:47:27 +02:00
ed36207a4c remove unneeded line 2025-07-04 14:16:48 +02:00
54a11344f7 remove old pipeline file 2025-07-04 14:12:54 +02:00
8bbae3691d no newline 2025-07-04 14:07:20 +02:00
06b116c5fd adds IGNORE_SUBMODULES as other makefile tries to pull everything anew 2025-07-04 13:54:24 +02:00
3c8f5045f2 time to build 2025-07-04 12:57:23 +02:00
1b82da8362 time to build 2025-07-04 12:55:24 +02:00
a908d56bad time to build 2025-07-04 12:53:13 +02:00
404a4cd713 typo 2025-07-04 12:51:04 +02:00
dc89906af0 it should already be there it is now a submodule... 2025-07-04 12:50:28 +02:00
b63f2c8cec :) 2025-07-04 12:45:16 +02:00
dd7c67e53e is the url wrong ? 2025-07-04 12:43:33 +02:00
50b61ef634 maybe a key is necessary 2025-07-04 12:38:57 +02:00
d70689626a Can I check out another repository? 2025-07-04 12:31:40 +02:00
f1f673df6e Can I check out another repository? 2025-07-04 12:30:53 +02:00
c1761a161c Disable the axis on reset, if it is not moving
Resetting the axis now also disables it, if it is not moving.
2025-07-01 13:11:06 +02:00
1495e9a0e3 Links in README.md updated to point to Gitea now. 2025-06-26 13:56:57 +02:00
62cec4d8e1 Updated sinqMotor 2025-06-17 08:34:07 +02:00
c1cb407ea3 Updated sinqMotor version 2025-06-16 16:18:06 +02:00
b27babfa10 Committed new sinqMotor version 2025-06-16 15:55:40 +02:00
7906b788f8 Added destructor for controller 2025-06-10 14:58:59 +02:00
08bd303ab3 Added destructor for controller 2025-06-10 14:53:26 +02:00
f93e16eb36 Added flag to disable reading the limits from the hardware 2025-06-10 13:53:39 +02:00
fb5ba8f14e Changed priority of IOC shell message 2025-06-06 11:20:50 +02:00
18bc3dfc5f Removed exit(-1) from init
When the initialization fails, the motor will now try again during each
poll.
2025-05-23 11:56:45 +02:00
738780f897 Change to latest sinqMotor version 2025-05-23 10:11:27 +02:00
2223a9b23e Fixed remote git link in repo. 2025-05-16 15:58:17 +02:00
4cf500cc96 Made some functions virtual so they can be overwritten in subclasses 2025-05-15 14:54:18 +02:00
e7dc673395 Fixed some merge bugs 2025-05-15 12:32:30 +02:00
572ee5c671 Merge branch 'static-dep' 2025-05-15 12:27:26 +02:00
2e5059da33 Added default value for motorMessageText 2025-05-15 12:25:08 +02:00
c945896da1 Addes error message for failing to enable / disable within timeout 2025-05-14 16:26:55 +02:00
1054b87467 Adjusted usage of motorMessageText to act as an error message only. 2025-05-14 16:17:14 +02:00
a7c82d1238 Use new version of sinqMotor 2025-05-14 16:13:10 +02:00
f6d7f3846d Allow enabling / disabling the motor regardless of the status returned by the poll 2025-05-13 14:44:24 +02:00
b53cf770ae Fixed small inaccuracy in the README 2025-05-12 17:04:09 +02:00
50192858e9 Fixed typo 2025-05-12 16:59:59 +02:00
d4bb77bae1 Added some comments that this library now uses sinqMotor as static
dependency.
2025-05-12 16:43:57 +02:00
3bafc5110c Fixed bug where the motor could be in state -6 and the driver would
interpret this as "not moving"
2025-05-12 16:19:34 +02:00
31875ddd99 Specified new version for sinqMotor 2025-05-12 12:00:49 +02:00
980ea59958 Pinned sinqMotor version 2025-05-12 11:58:56 +02:00
4ee211b481 Added sinqMotor as a submodule for static linking 2025-05-12 08:52:10 +02:00
5 changed files with 280 additions and 190 deletions

3
.gitmodules vendored
View File

@@ -1,6 +1,3 @@
[submodule "sinqmotor"]
path = sinqmotor
url = https://gitea.psi.ch/lin-epics-modules/sinqmotor
[submodule "sinqMotor"] [submodule "sinqMotor"]
path = sinqMotor path = sinqMotor
url = https://gitea.psi.ch/lin-epics-modules/sinqMotor url = https://gitea.psi.ch/lin-epics-modules/sinqMotor

View File

@@ -35,3 +35,4 @@ DBDS += sinqMotor/src/sinqMotor.dbd
DBDS += src/turboPmac.dbd DBDS += src/turboPmac.dbd
USR_CFLAGS += -Wall -Wextra -Wunused-result -Werror -fvisibility=hidden # -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
USR_CXXFLAGS += -Wall -Wextra -Wunused-result -Werror -fvisibility=hidden

View File

@@ -4,15 +4,26 @@
## 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://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 ## 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 ### IOC startup script
@@ -22,13 +33,15 @@ turboPmac exports the following IOC shell functions:
The full turboPmacX.cmd file looks like this: The full turboPmacX.cmd file looks like this:
``` ```bash
# Define the name of the controller and the corresponding port # Define the name of the controller and the corresponding port
epicsEnvSet("DRIVER_PORT","turboPmacX") epicsEnvSet("DRIVER_PORT","turboPmacX")
epicsEnvSet("IP_PORT","p$(DRIVER_PORT)") 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. # communicating with the controller directly.
pmacAsynIPPortConfigure("$(IP_PORT)","172.28.101.24:1025") pmacAsynIPPortConfigure("$(IP_PORT)","172.28.101.24:1025")
@@ -48,7 +61,8 @@ turboPmacAxis("$(DRIVER_PORT)",5);
# Set the number of subsequent timeouts # Set the number of subsequent timeouts
setMaxSubsequentTimeouts("$(DRIVER_PORT)", 20); 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); setThresholdComTimeout("$(DRIVER_PORT)", 300, 10);
# Parametrize the EPICS record database with the substitution file named after the MCU. # Parametrize the EPICS record database with the substitution file named after the MCU.
@@ -61,14 +75,58 @@ dbLoadRecords("$(turboPmac_DB)/asynRecord.db","P=$(INSTR)$(DRIVER_PORT),PORT=$(I
### Additional records ### 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 ## Developer guide
### Versioning ### 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 ### 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.
## FAQ
### Axis hardware error at startup
If at IOC startup you are met with the following errors:
```
2026/02/02 16:56:49.470 Controller "turboPmac1", axis 3 => asynStatus turboPmacAxis::handleError(int, char*, int), line 735
Driver hardware error triggered.
2026/02/02 16:56:49.485 Controller "turboPmac1", axis 7 => asynStatus turboPmacAxis::handleError(int, char*, int), line 735
Driver hardware error triggered.
2026/02/02 16:56:49.492 Controller "turboPmac1", axis 8 => asynStatus turboPmacAxis::handleError(int, char*, int), line 735
Driver hardware error triggered.
```
You may need to reset to do a axis reset. This can be done with
`utils/writeRead.py`. The following example does so for axis 3.
Confirm the hardware error:
```
utils/writeRead.py 172.28.87.24:1025 P0301 # 03 specifies axis 3, 01 is the command to read out the error.
# If it returns 13 it's a hardware error.
# For the full list of errors see TurboPMAC_manual.pdf or src/turboPmacAxis.cpp, function "handleError".
```
Reset the axis:
```
utils/writeRead.py 172.28.87.24:1025 P0301=0
```
Check if the error has appeared again:
```
utils/writeRead.py 172.28.87.24:1025 P0301
```
If the console output is not 0, the error has been deleted, but appeared
immediately again. In this case, the error cannot be reset remotely.
If it is an error such as 10 (limit switches hit), the motor needs to be
moved away from the limits, this resets the error automatically.
Other errors like 13 represent an actual issue on the hardware which
needs to be resolved by the electronics motion engineers.

View File

@@ -179,22 +179,38 @@ asynStatus turboPmacAxis::init() {
"Q%2.2d10 Q%2.2d03 Q%2.2d04 Q%2.2d06 P%2.2d22 Q%2.2d00 I%2.2d65", "Q%2.2d10 Q%2.2d03 Q%2.2d04 Q%2.2d06 P%2.2d22 Q%2.2d00 I%2.2d65",
axisNo_, axisNo_, axisNo_, axisNo_, axisNo_, axisNo_, axisNo_); axisNo_, axisNo_, axisNo_, axisNo_, axisNo_, axisNo_, axisNo_);
status = pC_->writeRead(axisNo_, command, response, 7); status = pC_->writeRead(axisNo_, command, response, 7);
msgPrintControlKey keyDisconnected = msgPrintControlKey(
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, 1);
if (status != asynSuccess) { if (status != asynSuccess) {
asynPrint( if (pC_->getMsgPrintControl().shouldBePrinted(keyDisconnected, true,
pC_->pasynUser(), ASYN_TRACE_ERROR, pC_->pasynUser())) {
"Controller \"%s\", axis %d => %s, line %d\nCould not communicate " asynPrint(
"with controller during IOC initialization. Check if you used " pC_->pasynUser(), ASYN_TRACE_ERROR,
"\"pmacAsynIPPortConfigure\" instead of the standard " "Controller \"%s\", axis %d => %s, line %d\nCould not "
"\"drvAsynIPPortConfigure\" function in the .cmd file in order to " "communicate with controller during IOC initialization (error "
"create the port driver.\n", "%s). Did you use \"drvAsynIPPortConfigure\" instead of "
pC_->portName, axisNo(), __PRETTY_FUNCTION__, __LINE__); "\"pmacAsynIPPortConfigure\" in the .cmd file to create the "
"port driver?\n",
pC_->portName, axisNo(), __PRETTY_FUNCTION__, __LINE__,
pC_->stringifyAsynStatus(status));
}
pTurboPmacA_->needInit = true; pTurboPmacA_->needInit = true;
return status;
} }
// 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, nvals = sscanf(response, "%lf %lf %lf %lf %d %lf %lf", &motorPos,
&motorVmax, &motorVelocity, &motorAccel, &acoDelay, &motorVmax, &motorVelocity, &motorAccel, &acoDelay,
&counts_to_eu, &deadband_counts); &counts_to_eu, &deadband_counts);
// The acoDelay is given in milliseconds -> Convert to seconds, rounded up // The acoDelay is given in milliseconds -> Convert to seconds, rounded
// up
setOffsetMovTimeout(std::ceil(acoDelay / 1000.0)); setOffsetMovTimeout(std::ceil(acoDelay / 1000.0));
// The PMAC electronic specifies the acceleration in m/s^2. Since we // The PMAC electronic specifies the acceleration in m/s^2. Since we
@@ -227,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. 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 The values of Qxx10 and Ixx65 are read out during initialization and are
assumed to not change during operation. assumed to not change during operation.
@@ -249,14 +265,15 @@ asynStatus turboPmacAxis::init() {
// Update the parameter library immediately // Update the parameter library immediately
status = callParamCallbacks(); status = callParamCallbacks();
if (status != asynSuccess) { 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 "
"failed with %s.\n", "%d\ncallParamCallbacks "
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, "failed with %s.\n",
pC_->stringifyAsynStatus(status)); pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
pC_->stringifyAsynStatus(status));
return status; return status;
} }
@@ -341,13 +358,13 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
} }
if (error != 0) { 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; pTurboPmacA_->waitForHandshake = false;
} else if (handshakePerformed == 1) { } 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; pTurboPmacA_->waitForHandshake = false;
} else { } else {
// Still waiting for the handshake - try again in the next busy // Still waiting for the handshake - try again in the next busy
@@ -387,15 +404,16 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
/* /*
The axis limits are set as: ({[]}) 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 [-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); getAxisParamChecked(this, motorLimitsOffset, &limitsOffset);
highLimit = highLimit - limitsOffset; highLimit = highLimit - limitsOffset;
@@ -411,8 +429,8 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
(axStatus != -3 && axStatus != -5)); (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( msgPrintControlKey keyStatus = msgPrintControlKey(
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__); pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
bool resetCountStatus = true; bool resetCountStatus = true;
@@ -433,12 +451,12 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
if (pC_->getMsgPrintControl().shouldBePrinted(keyStatus, true, if (pC_->getMsgPrintControl().shouldBePrinted(keyStatus, true,
pC_->pasynUser())) { 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", "activated.%s\n",
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
pC_->getMsgPrintControl().getSuffix()); pC_->getMsgPrintControl().getSuffix());
} }
resetCountStatus = false; resetCountStatus = false;
setAxisParamChecked(this, motorMessageText, "Emergency stop"); setAxisParamChecked(this, motorMessageText, "Emergency stop");
@@ -508,8 +526,8 @@ asynStatus turboPmacAxis::doPoll(bool *moving) {
*moving = false; *moving = false;
break; break;
case 15: 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; *moving = true;
break; break;
case 16: case 16:
@@ -604,13 +622,13 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
if (pC_->getMsgPrintControl().shouldBePrinted( if (pC_->getMsgPrintControl().shouldBePrinted(
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true, pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
pC_->pasynUser())) { 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 " "still moving, but received another move command. EPICS "
"still moving, but received another move command. EPICS " "should prevent this, check if *moving is set "
"should prevent this, check if *moving is set correctly.%s\n", "correctly.%s\n",
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
pC_->getMsgPrintControl().getSuffix()); pC_->getMsgPrintControl().getSuffix());
} }
setAxisParamChecked(this, motorMessageText, setAxisParamChecked(this, motorMessageText,
"Axis received move command while it is still " "Axis received move command while it is still "
@@ -620,14 +638,17 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
if (pC_->getMsgPrintControl().shouldBePrinted( if (pC_->getMsgPrintControl().shouldBePrinted(
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true, pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
pC_->pasynUser())) { 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, 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.", "%d). Please call the support.",
axisNo_, error); axisNo_, error);
setAxisParamChecked(this, motorMessageText, userMessage); setAxisParamChecked(this, motorMessageText, userMessage);
@@ -636,26 +657,27 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
if (pC_->getMsgPrintControl().shouldBePrinted( if (pC_->getMsgPrintControl().shouldBePrinted(
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true, pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
pC_->pasynUser())) { 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,
"%d). Please call the support.", "No feedback from auxiliary device before movement (P%2.2d01 = "
axisNo_, error); "%d). Please call the support.",
axisNo_, error);
setAxisParamChecked(this, motorMessageText, userMessage); setAxisParamChecked(this, motorMessageText, userMessage);
break; break;
case 10: 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( if (pC_->getMsgPrintControl().shouldBePrinted(
@@ -682,12 +704,12 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
if (pC_->getMsgPrintControl().shouldBePrinted( if (pC_->getMsgPrintControl().shouldBePrinted(
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true, pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, true,
pC_->pasynUser())) { 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", "following error exceeded.%s\n",
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
pC_->getMsgPrintControl().getSuffix()); pC_->getMsgPrintControl().getSuffix());
} }
snprintf(userMessage, sizeUserMessage, snprintf(userMessage, sizeUserMessage,
"Maximum allowed following error exceeded (P%2.2d01 = %d). " "Maximum allowed following error exceeded (P%2.2d01 = %d). "
@@ -727,10 +749,10 @@ asynStatus turboPmacAxis::handleError(int error, char *userMessage,
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
pC_->getMsgPrintControl().getSuffix()); 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_); axisNo_);
setAxisParamChecked(this, motorMessageText, userMessage); setAxisParamChecked(this, motorMessageText, userMessage);
break; break;
case 14: case 14:
@@ -787,14 +809,18 @@ asynStatus turboPmacAxis::doMove(double position, int relative,
// ========================================================================= // =========================================================================
// Suppress unused variables warning
(void)minVelocity;
(void)acceleration;
getAxisParamChecked(this, motorEnableRBV, &enabled); getAxisParamChecked(this, motorEnableRBV, &enabled);
getAxisParamChecked(this, motorRecResolution, &motorRecResolution); getAxisParamChecked(this, motorRecResolution, &motorRecResolution);
if (enabled == 0) { 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__); pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
return asynSuccess; return asynSuccess;
} }
@@ -812,8 +838,8 @@ asynStatus turboPmacAxis::doMove(double position, int relative,
getAxisParamChecked(this, motorCanSetSpeed, &motorCanSetSpeed); getAxisParamChecked(this, motorCanSetSpeed, &motorCanSetSpeed);
// Prepend the new motor speed, if the user is allowed to set the speed. // 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) { if (motorCanSetSpeed != 0) {
snprintf(command, sizeof(command), "Q%2.2d04=%lf ", axisNo_, snprintf(command, sizeof(command), "Q%2.2d04=%lf ", axisNo_,
motorVelocity); motorVelocity);
@@ -826,8 +852,8 @@ asynStatus turboPmacAxis::doMove(double position, int relative,
motorVelocity); 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) { if (relative) {
snprintf(&command[writeOffset], sizeof(command) - writeOffset, snprintf(&command[writeOffset], sizeof(command) - writeOffset,
"P%2.2d23=0 Q%2.2d02=%lf M%2.2d=2", axisNo_, axisNo_, "P%2.2d23=0 Q%2.2d02=%lf M%2.2d=2", axisNo_, axisNo_,
@@ -842,18 +868,18 @@ asynStatus turboPmacAxis::doMove(double position, int relative,
status = pC_->writeRead(axisNo_, command, response, 0); status = pC_->writeRead(axisNo_, command, response, 0);
if (status != asynSuccess) { 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", "target position %lf failed.\n",
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
motorTargetPosition); motorTargetPosition);
setAxisParamChecked(this, motorStatusProblem, true); setAxisParamChecked(this, motorStatusProblem, true);
return status; 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_->waitForHandshake = true;
pTurboPmacA_->timeAtHandshake = time(NULL); pTurboPmacA_->timeAtHandshake = time(NULL);
@@ -875,29 +901,32 @@ asynStatus turboPmacAxis::stop(double acceleration) {
// ========================================================================= // =========================================================================
// Suppress unused variables warning
(void)acceleration;
snprintf(command, sizeof(command), "M%2.2d=8", axisNo_); snprintf(command, sizeof(command), "M%2.2d=8", axisNo_);
status = pC_->writeRead(axisNo_, command, response, 0); status = pC_->writeRead(axisNo_, command, response, 0);
if (status != asynSuccess) { 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", "failed.\n",
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__); pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__);
setAxisParamChecked(this, motorStatusProblem, true); 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; 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 idlePollMicros =
(unsigned int)ceil(pC_->idlePollPeriod() * 1e6); (unsigned int)ceil(pC_->idlePollPeriod() * 1e6);
@@ -928,8 +957,8 @@ asynStatus turboPmacAxis::doReset() {
setAxisParamChecked(this, motorStatusProblem, true); 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; pTurboPmacA_->waitForHandshake = false;
// Disable the axis // Disable the axis
@@ -939,7 +968,7 @@ asynStatus turboPmacAxis::doReset() {
/* /*
Home the axis. On absolute encoder systems, this is a no-op 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) { double acceleration, int forwards) {
// Status of read-write-operations of ASCII commands to the controller // Status of read-write-operations of ASCII commands to the controller
@@ -950,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); getAxisParamChecked(this, encoderType, &response);
// Only send the home command if the axis has an incremental encoder // Only send the home command if the axis has an incremental encoder
@@ -1021,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() { asynStatus turboPmacAxis::rereadEncoder() {
char command[pC_->MAXBUF_] = {0}; char command[pC_->MAXBUF_] = {0};
@@ -1071,11 +1107,12 @@ asynStatus turboPmacAxis::rereadEncoder() {
return asynError; return asynError;
} else { } else {
snprintf(command, sizeof(command), "M%2.2d=15", axisNo_); 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", "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); pC_->writeRead(axisNo_, command, response, 0);
} }
@@ -1084,8 +1121,8 @@ asynStatus turboPmacAxis::rereadEncoder() {
// it is actually finished, so we instead wait for 0.5 seconds. // it is actually finished, so we instead wait for 0.5 seconds.
usleep(500000); 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); setAxisParamChecked(this, rereadEncoderPosition, false);
return asynSuccess; return asynSuccess;
} }
@@ -1105,27 +1142,28 @@ asynStatus turboPmacAxis::enable(bool on) {
/* /*
Continue regardless of the status returned by the poll; we just want to 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 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; bool moving = false;
doPoll(&moving); doPoll(&moving);
// If the axis is currently moving, it cannot be disabled. Ignore the // 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; int axStatus = pTurboPmacA_->axisStatus;
if (axStatus == 1 || axStatus == 2 || axStatus == 3 || axStatus == 4 || if (axStatus == 1 || axStatus == 2 || axStatus == 3 || axStatus == 4 ||
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( asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
pC_->pasynUser(), ASYN_TRACE_ERROR, "Controller \"%s\", axis %d => %s, line %d\nAxis is not "
"Controller \"%s\", axis %d => %s, line %d\nAxis is not " "idle (status %d) and can therefore not be enabled / "
"idle (status %d) and can therefore not be enabled / disabled.\n", "disabled.\n",
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, axStatus); 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.");
@@ -1136,11 +1174,11 @@ asynStatus turboPmacAxis::enable(bool on) {
// Axis is already enabled / disabled and a new enable / disable command // Axis is already enabled / disabled and a new enable / disable command
// was sent => Do nothing // was sent => Do nothing
if ((axStatus != -3) == on) { 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__, pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
on ? "enabled" : "disabled"); on ? "enabled" : "disabled");
return asynSuccess; return asynSuccess;
} }
@@ -1289,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/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"
@@ -1313,14 +1351,15 @@ static const iocshArg *const CreateAxisArgs[] = {&CreateAxisArg0,
static const iocshFuncDef configTurboPmacCreateAxis = { static const iocshFuncDef configTurboPmacCreateAxis = {
"turboPmacAxis", 2, CreateAxisArgs, "turboPmacAxis", 2, CreateAxisArgs,
"Create an instance of a turboPmac axis. The first argument is the " "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."}; "axis number."};
static void configTurboPmacCreateAxisCallFunc(const iocshArgBuf *args) { static void configTurboPmacCreateAxisCallFunc(const iocshArgBuf *args) {
turboPmacCreateAxis(args[0].sval, args[1].ival); 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) { static void turboPmacAxisRegister(void) {
iocshRegister(&configTurboPmacCreateAxis, iocshRegister(&configTurboPmacCreateAxis,
configTurboPmacCreateAxisCallFunc); configTurboPmacCreateAxisCallFunc);

View File

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