Compare commits
14 Commits
Author | SHA1 | Date | |
---|---|---|---|
5689402375 | |||
2a7934b8d6 | |||
3071e402b2 | |||
dd0610fd99 | |||
c7936191d9 | |||
3ec83b115e | |||
bfda809257 | |||
76a91d4a2f | |||
228bcf7fd7 | |||
db03ffea0e | |||
4c3254687d | |||
eb94379efe | |||
1dd132c709 | |||
7729eceb28 |
119
README.md
119
README.md
@ -8,7 +8,7 @@ This library offers base classes for EPICS motor drivers (`sinqAxis` and `sinqCo
|
|||||||
|
|
||||||
### Architecture of EPICS motor drivers at SINQ
|
### Architecture of EPICS motor drivers at SINQ
|
||||||
|
|
||||||
The asyn-framework offers two base classes `asynMotorAxis` and `asynMotorController`. At SINQ, we extend those classes by two children `sinqAxis` and `sinqController` which are not complete drivers on their own, but serve as an additional framework for writing drivers. The concrete drivers are then created as separated libraries, an example is the TurboPMAC-driver: https://git.psi.ch/sinq-epics-modules/turboPmac.
|
The asyn-framework offers two base classes `asynMotorAxis` and `asynMotorController`. At SINQ, we extend those classes by two children `sinqAxis` and `sinqController` which are not complete drivers on their own, but serve as a framework extension for writing drivers. The concrete drivers are then created as separated libraries, an example is the TurboPMAC-driver: https://git.psi.ch/sinq-epics-modules/turboPmac.
|
||||||
|
|
||||||
The full inheritance chain for two different motor drivers "a" and "b" looks like this:
|
The full inheritance chain for two different motor drivers "a" and "b" looks like this:
|
||||||
`asynController -> sinqController -> aController`
|
`asynController -> sinqController -> aController`
|
||||||
@ -17,9 +17,48 @@ The full inheritance chain for two different motor drivers "a" and "b" looks lik
|
|||||||
`asynController -> sinqController -> bController`
|
`asynController -> sinqController -> bController`
|
||||||
`asynAxis -> sinqAxis -> bAxis`
|
`asynAxis -> sinqAxis -> bAxis`
|
||||||
|
|
||||||
Those inheritance chains are created at runtime by loading shared libraries. Therefore, it is important to load compatible versions. At SINQ, the versioning numbers follow the SemVer standard (https://semver.org/lang/de/). For example, if driver "a" depends on version 2.1.0 of "sinqMotor", then it is safe to use "sinqMotor" 2.5.3 since 2.5.3 is backwards compatible to 2.1.0. However, it is not allowed to use e.g. version 1.9.0 or 2.0.0 or 3.0.1 instead. For more details on SemVer, please refer to the official documentation.
|
Those inheritance chains are created at runtime by loading shared libraries. These libraries must be compatible to each other (see next section).
|
||||||
|
|
||||||
To find out which version of sinqMotor is needed by driver "a", refer to its Makefile (line `sinqMotor_VERSION=x.x.x`, where x.x.x is the minimum required version).
|
### Versioning
|
||||||
|
|
||||||
|
In order to make sure the shared libraries are compatible to each other, we use the "require" framework extension for EPICS (https://github.com/paulscherrerinstitute/require). If a shared library has another library as a dependency, it is checked whether the latter is already loaded. If yes, the loaded version is considered compatible if:
|
||||||
|
|
||||||
|
1) no specific version was required by the former library
|
||||||
|
2) the already loaded version matches the required version exactly
|
||||||
|
3) major and minor numbers are the same and already loaded patch number is equal to the required one or higher
|
||||||
|
4) major numbers are the same and already loaded minor number is higher than the required one
|
||||||
|
5) the already loaded version is a test version and the required version is not a test version
|
||||||
|
These rules are in complicance with the SemVer standard (https://semver.org/lang/de/)
|
||||||
|
|
||||||
|
If the dependency hasn't been loaded yet, it is loaded now. In case no specific version is required, the latest numbered version is used.
|
||||||
|
|
||||||
|
Because these rules are checked sequentially for each required dependency and no unloading is performed, it is important to consider the order of required libraries. Consider the following example:
|
||||||
|
|
||||||
|
```
|
||||||
|
require "libDriverA" # sinqMotor 1.2 is specified as a dependency
|
||||||
|
require "libDriverB" # sinqMotor 1.0 is specified as a dependency
|
||||||
|
```
|
||||||
|
`require` first checks the dependencies of `libDriverA` and sees that `sinqMotor 1.2` is required. It therefore load `sinqMotor 1.2` and then `libDriverA`. Now the next `require` starts analyzing the dependencies of `libDriverB` and sees that `sinqMotor 1.0` is required. Since `sinqMotor 1.2` is already loaded, rule 4) is applied and `libDriverB` is assumed to be compatible with `sinqMotor 1.2` as well (which it should be according to SemVer).
|
||||||
|
|
||||||
|
When the order is inverted, the following happens:
|
||||||
|
```
|
||||||
|
require "libDriverB" # sinqMotor 1.0 is specified as a dependency
|
||||||
|
require "libDriverA" # sinqMotor 1.2 is specified as a dependency
|
||||||
|
```
|
||||||
|
`require` first checks the dependencies of `libDriverB` and sees that `sinqMotor 1.0` is required. It therefore load `sinqMotor 1.0` and then `libDriverB`. Now the next `require` starts analyzing the dependencies of `libDriverA` and sees that `sinqMotor 1.2` is required. Since `sinqMotor 1.0` is already loaded, `require` cannot load `sinqMotor 1.2`. Therefore the IOC startup is aborted with an error message.
|
||||||
|
|
||||||
|
In order to make the setup script more robust, it is therefore recommended to explicitly add a dependency version which is compatible to all required libraries:
|
||||||
|
|
||||||
|
```
|
||||||
|
require "sinqMotor", "1.2"
|
||||||
|
require "libDriverB" # sinqMotor 1.0 is specified as a dependency
|
||||||
|
require "libDriverA" # sinqMotor 1.2 is specified as a dependency
|
||||||
|
```
|
||||||
|
The IOC startup now succeeds because we made sure the higher version is loaded first.
|
||||||
|
|
||||||
|
Please see the README.md of https://github.com/paulscherrerinstitute/require for more details.
|
||||||
|
|
||||||
|
To find out which version of sinqMotor is needed by a driver, refer to its Makefile (line `sinqMotor_VERSION=x.x.x`, where x.x.x is the minimum required version).
|
||||||
|
|
||||||
### IOC startup script
|
### IOC startup script
|
||||||
|
|
||||||
@ -29,28 +68,28 @@ An EPICS IOC for motor control at SINQ is started by executing a script with the
|
|||||||
|
|
||||||
# Load libraries needed for the IOC
|
# Load libraries needed for the IOC
|
||||||
require sinqMotor, 1.0.0
|
require sinqMotor, 1.0.0
|
||||||
require turboPmac, 1.2.0
|
require actualDriver, 1.2.0
|
||||||
|
|
||||||
# Define environment variables used later to parametrize the individual controllers
|
# Define environment variables used later to parametrize the individual controllers
|
||||||
epicsEnvSet("TOP","/ioc/sinq-ioc/sinqtest-ioc/")
|
epicsEnvSet("TOP","/ioc/sinq-ioc/sinqtest-ioc/")
|
||||||
epicsEnvSet("INSTR","SQ:SINQTEST:")
|
epicsEnvSet("INSTR","SQ:SINQTEST:")
|
||||||
|
|
||||||
# Include other scripts for the controllers 1 and 2
|
# Include other scripts for the controllers 1 and 2
|
||||||
< mcu1.cmd
|
< actualDriver.cmd
|
||||||
< mcu2.cmd
|
< actualDriver.cmd
|
||||||
|
|
||||||
iocInit()
|
iocInit()
|
||||||
```
|
```
|
||||||
The first line is a so-called shebang which instructs Linux to execute the file with the executable located at the given path - the IOC shell in this case. The controller script "mcu1.cmd" looks like this:
|
The first line is a so-called shebang which instructs Linux to execute the file with the executable located at the given path - the IOC shell in this case. The controller script "mcu1.cmd" looks like this:
|
||||||
The script for controller 1 ("mcu1.cmd") for a Turbo PMAC (see https://git.psi.ch/sinq-epics-modules/turboPmac) has the following structure. The scripts for other controller types can be found in the README.md of their respective repositories.
|
The script for controller 1 ("turboPmac1.cmd") for a Turbo PMAC (see https://git.psi.ch/sinq-epics-modules/turboPmac) has the following structure. The scripts for other controller types can be found in the README.md of their respective repositories.
|
||||||
|
|
||||||
```
|
```
|
||||||
# Define the name of the controller and the corresponding port
|
# Define the name of the controller and the corresponding port
|
||||||
epicsEnvSet("NAME","mcu1")
|
epicsEnvSet("DRIVER_PORT","actualDriver1")
|
||||||
epicsEnvSet("ASYN_PORT","p$(NAME)")
|
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 adressed from within the IOC shell via the port name
|
||||||
drvAsynIPPortConfigure("$(ASYN_PORT)","172.28.101.24:1025")
|
drvAsynIPPortConfigure("$(IP_PORT)","172.28.101.24:1025")
|
||||||
|
|
||||||
# Create the controller object with the defined name and connect it to the socket via the port name.
|
# Create the controller object with the defined name and connect it to the socket via the port name.
|
||||||
# The other parameters are as follows:
|
# The other parameters are as follows:
|
||||||
@ -58,25 +97,25 @@ drvAsynIPPortConfigure("$(ASYN_PORT)","172.28.101.24:1025")
|
|||||||
# 0.05: Busy poll period in seconds
|
# 0.05: Busy poll period in seconds
|
||||||
# 1: Idle poll period in seconds
|
# 1: Idle poll period in seconds
|
||||||
# 1: Socket communication timeout in seconds
|
# 1: Socket communication timeout in seconds
|
||||||
turboPmacController("$(NAME)", "$(ASYN_PORT)", 8, 0.05, 1, 1);
|
actualDriverController("$(DRIVER_PORT)", "$(IP_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!
|
# Define some axes for the specified motor controller at the given slot (1, 2 and 5). No slot may be used twice!
|
||||||
turboPmacAxis("$(NAME)",1);
|
actualDriverAxis("$(DRIVER_PORT)",1);
|
||||||
turboPmacAxis("$(NAME)",2);
|
actualDriverAxis("$(DRIVER_PORT)",2);
|
||||||
turboPmacAxis("$(NAME)",5);
|
actualDriverAxis("$(DRIVER_PORT)",5);
|
||||||
|
|
||||||
# Set the number of subsequent timeouts
|
# Set the number of subsequent timeouts
|
||||||
setMaxSubsequentTimeouts("$(NAME)", 20);
|
setMaxSubsequentTimeouts("$(DRIVER_PORT)", 20);
|
||||||
|
|
||||||
# Configure the timeout frequency watchdog:
|
# Configure the timeout frequency watchdog: A maximum of 10 timeouts are allowed in 300 seconds before an alarm message is sent.
|
||||||
setThresholdComTimeout("$(NAME)", 100, 1);
|
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 motor controller.
|
||||||
epicsEnvSet("SINQDBPATH","$(sinqMotor_DB)/sinqMotor.db")
|
epicsEnvSet("SINQDBPATH","$(sinqMotor_DB)/sinqMotor.db")
|
||||||
dbLoadTemplate("$(TOP)/$(NAME).substitutions", "INSTR=$(INSTR)$(NAME):,CONTROLLER=$(NAME)")
|
dbLoadTemplate("$(TOP)/$(DRIVER_PORT).substitutions", "INSTR=$(INSTR)$(DRIVER_PORT):,CONTROLLER=$(DRIVER_PORT)")
|
||||||
epicsEnvSet("SINQDBPATH","$(turboPmac_DB)/turboPmac.db")
|
epicsEnvSet("SINQDBPATH","$(actualDriver_DB)/turboPmac.db")
|
||||||
dbLoadTemplate("$(TOP)/$(NAME).substitutions", "INSTR=$(INSTR)$(NAME):,CONTROLLER=$(NAME)")
|
dbLoadTemplate("$(TOP)/$(DRIVER_PORT).substitutions", "INSTR=$(INSTR)$(DRIVER_PORT):,CONTROLLER=$(DRIVER_PORT)")
|
||||||
dbLoadRecords("$(sinqMotor_DB)/asynRecord.db","P=$(INSTR)$(NAME),PORT=$(ASYN_PORT)")
|
dbLoadRecords("$(sinqMotor_DB)/asynRecord.db","P=$(INSTR)$(DRIVER_PORT),PORT=$(IP_PORT)")
|
||||||
```
|
```
|
||||||
|
|
||||||
### Substitution file
|
### Substitution file
|
||||||
@ -87,11 +126,11 @@ To work with sinqMotor, "mcu1.substitutions" needs to look like this (the order
|
|||||||
file "$(SINQDBPATH)"
|
file "$(SINQDBPATH)"
|
||||||
{
|
{
|
||||||
pattern
|
pattern
|
||||||
{ AXIS, M, DESC, EGU, DIR, MRES, MSGTEXTSIZE, ENABLEMOVWATCHDOG, LIMITSOFFSET, CANSETSPEED }
|
{ AXIS, M, DESC, EGU, DIR, MRES, MSGTEXTSIZE, ENABLEMOVWATCHDOG, LIMITSOFFSET, CANSETSPEED, ADAPTPOLL }
|
||||||
{ 1, "lin1", "Linear motor doing whatever", mm, Pos, 0.001, 200, 1, 1.0, 1 }
|
{ 1, "lin1", "Linear motor doing whatever", mm, Pos, 0.001, 200, 1, 1.0, 1, 1 }
|
||||||
{ 2, "rot1", "First rotary motor", degree, Neg, 0.001, 200, 0, 1.0, 0 }
|
{ 2, "rot1", "First rotary motor", degree, Neg, 0.001, 200, 0, 1.0, 0, 1 }
|
||||||
{ 3, "rot2", "Second rotary motor", degree, Pos, 0.001, 200, 0, 0.0, 1 }
|
{ 3, "rot2", "Second rotary motor", degree, Pos, 0.001, 200, 0, 0.0, 1, 0 }
|
||||||
{ 5, "rot3", "Surprise: Third rotary motor", degree, Pos, 0.001, 200, 1, 2.0, 0 }
|
{ 5, "rot3", "Surprise: Third rotary motor", degree, Pos, 0.001, 200, 1, 2.0, 0, 0 }
|
||||||
}
|
}
|
||||||
```
|
```
|
||||||
The variable `SINQDBPATH` has been set in "mcu1.cmd" before calling `dbLoadTemplate`.
|
The variable `SINQDBPATH` has been set in "mcu1.cmd" before calling `dbLoadTemplate`.
|
||||||
@ -99,21 +138,22 @@ The variable `SINQDBPATH` has been set in "mcu1.cmd" before calling `dbLoadTempl
|
|||||||
#### Mandatory parameters
|
#### Mandatory parameters
|
||||||
|
|
||||||
- `AXIS`: Index of the axis, corresponds to the physical connection of the axis to the MCU.
|
- `AXIS`: Index of the axis, corresponds to the physical connection of the axis to the MCU.
|
||||||
- `M`: The full PV name is created by concatenating the variables INSTR, NAME and M. For example, the PV of the first axis would be "SQ:SINQTEST:mcu1:lin1".
|
- `M`: The full PV name is created by concatenating the variables INSTR, DRIVER_PORT and M. For example, the PV of the first axis would be "SQ:SINQTEST:mcu1:lin1".
|
||||||
- `EGU`: Engineering units. For a linear motor, this is mm, for a rotaty motor, this is degree.
|
- `EGU`: Engineering units. For a linear motor, this is mm, for a rotaty motor, this is degree.
|
||||||
- `DIR`: If set to "Neg", the axis direction is inverted.
|
- `DIR`: If set to "Neg", the axis direction is inverted.
|
||||||
- `MRES`: This is a scaling factor determining the resolution of the position readback value. For example, 0.001 means a precision of 1 um. A detailed description can be found in section [Motor record resolution MRES](#motor-record-resolution-mres).
|
- `MRES`: This is a scaling factor determining the resolution of the position readback value. For example, 0.001 means a precision of 1 um. A detailed description can be found in section [Motor record resolution MRES](#motor-record-resolution-mres).
|
||||||
|
|
||||||
#### Optional parameters
|
#### Optional parameters
|
||||||
The default values for those parameters are given for the individual records in db/sinqMotor.db
|
The default values for those parameters are given for the individual records in db/sinqMotor.db
|
||||||
- `DESC`: Description of the motor. This field is just for documentation and is not needed for operating a motor.
|
- `DESC`: Description of the motor. This field is just for documentation and is not needed for operating a motor. Defaults to the motor name.
|
||||||
- `MSGTEXTSIZE`: Buffer size for the motor message record in characters
|
- `MSGTEXTSIZE`: Buffer size for the motor message record in characters. Defaults to 200 characters
|
||||||
- `ENABLEMOVWATCHDOG`: Sets `setWatchdogEnabled` during IOC startup to the given value.
|
- `ENABLEMOVWATCHDOG`: Sets `setWatchdogEnabled` during IOC startup to the given value. Defaults to 0.
|
||||||
- `LIMITSOFFSET`: If the motor limits are read out from the controller, they can
|
- `LIMITSOFFSET`: If the motor limits are read out from the controller, they can
|
||||||
be further reduced by this offset in order to avoid errors due to slight overshoot
|
be further reduced by this offset in order to avoid errors due to slight overshoot
|
||||||
on the motor controller. For example, if this value is 1.0 and the read-out limits
|
on the motor controller. For example, if this value is 1.0 and the read-out limits
|
||||||
are [-10.0 10.0], the EPICS limits are set to [-9.0 9.0]. This parameter uses engineering units (EGU).
|
are [-10.0 10.0], the EPICS limits are set to [-9.0 9.0]. This parameter uses engineering units (EGU). Defaults to 0.0.
|
||||||
- `CANSETSPEED`: If set to 1, the motor speed can be modified by the user.
|
- `CANSETSPEED`: If set to 1, the motor speed can be modified by the user. Defaults to 0.
|
||||||
|
- `ADAPTPOLL`: If set to any value other than 0, adaptive polling is enabled for this particular axis. Adaptive polling is designed to reduce the communication load in case some axis is moving. By default, if at least one axis is moving, all axes are polled using the busy / moving poll period (see [IOC startup script](#ioc-startup-script)). Adaptive polling modifies this behaviour so that the affected axis is only polled with the busy / moving poll period if it itself is moving. Defaults to 1.
|
||||||
|
|
||||||
### Motor record resolution MRES
|
### Motor record resolution MRES
|
||||||
|
|
||||||
@ -155,6 +195,10 @@ coupling, changes to the parameter library via setDoubleParam are NOT
|
|||||||
transferred to (motor_record_pv_name).MRES or to
|
transferred to (motor_record_pv_name).MRES or to
|
||||||
(motor_record_pv_name):Resolution.
|
(motor_record_pv_name):Resolution.
|
||||||
|
|
||||||
|
### Additional records
|
||||||
|
|
||||||
|
`sinqMotor` provides a variety of additional records. See `db/sinqMotor.db` for the complete list and the documentation.
|
||||||
|
|
||||||
## Developer guide
|
## Developer guide
|
||||||
|
|
||||||
### Base classes
|
### Base classes
|
||||||
@ -162,7 +206,7 @@ transferred to (motor_record_pv_name).MRES or to
|
|||||||
sinqMotor offers a variety of additional methods for children classes to standardize certain patterns (e.g. writing messages to the IOC shell and the motor message PV). For a detailed description, please see the respective function documentation in the .h-files. All of these functions can be overwritten manually if e.g. a completely different implementation of `poll` is required. Some functions are marked as virtual, because they are called from other functions of sinqMotor and therefore need runtime polymorphism. Functions without that marker are not called anywhere in sinqMotor.
|
sinqMotor offers a variety of additional methods for children classes to standardize certain patterns (e.g. writing messages to the IOC shell and the motor message PV). For a detailed description, please see the respective function documentation in the .h-files. All of these functions can be overwritten manually if e.g. a completely different implementation of `poll` is required. Some functions are marked as virtual, because they are called from other functions of sinqMotor and therefore need runtime polymorphism. Functions without that marker are not called anywhere in sinqMotor.
|
||||||
|
|
||||||
#### sinqController.h
|
#### sinqController.h
|
||||||
- `errMsgCouldNotParseResponse`: Write a standardized message if parsing a device response failed.
|
- `couldNotParseResponse`: Write a standardized message if parsing a device response failed.
|
||||||
- `paramLibAccessFailed`: Write a standardized message if accessing the parameter library failed.
|
- `paramLibAccessFailed`: Write a standardized message if accessing the parameter library failed.
|
||||||
- `stringifyAsynStatus`: Convert the enum `asynStatus` into a human-readable string.
|
- `stringifyAsynStatus`: Convert the enum `asynStatus` into a human-readable string.
|
||||||
- `checkComTimeoutWatchdog`: Calculates the timeout frequency (number of timeouts in a given time) and informs the user if a specified limit has been exceeded.
|
- `checkComTimeoutWatchdog`: Calculates the timeout frequency (number of timeouts in a given time) and informs the user if a specified limit has been exceeded.
|
||||||
@ -174,7 +218,8 @@ sinqMotor offers a variety of additional methods for children classes to standar
|
|||||||
- `enable`: This function is called if the `$(INSTR)$(M):Enable` PV from db/sinqMotor.db is set.
|
- `enable`: This function is called if the `$(INSTR)$(M):Enable` PV from db/sinqMotor.db is set.
|
||||||
This is an empty function which should be overwritten by concrete driver implementations.
|
This is an empty function which should be overwritten by concrete driver implementations.
|
||||||
- `reset`: This function is called when the `$(INSTR)$(M):Reset` PV from db/sinqMotor.db is set.
|
- `reset`: This function is called when the `$(INSTR)$(M):Reset` PV from db/sinqMotor.db is set.
|
||||||
This is an empty function which should be overwritten by concrete driver implementations.
|
It calls `doReset` and performs some fast polls after `doReset` returns.
|
||||||
|
- `doReset`: This is an empty function which should be overwritten by concrete driver implementations.
|
||||||
- `move`: This function sets the absolute target position in the parameter library and then calls `doMove`.
|
- `move`: This function sets the absolute target position in the parameter library and then calls `doMove`.
|
||||||
- `doMove`: This is an empty function which should be overwritten by concrete driver implementations.
|
- `doMove`: This is an empty function which should be overwritten by concrete driver implementations.
|
||||||
- `home`: This function sets the internal status flags for the homing process and then calls doHome.
|
- `home`: This function sets the internal status flags for the homing process and then calls doHome.
|
||||||
@ -190,6 +235,8 @@ This is an empty function which should be overwritten by concrete driver impleme
|
|||||||
- Reset `motorStatusProblem_`, `motorStatusCommsError_` and `motorMessageText_` if `doPoll` returned `asynSuccess`
|
- Reset `motorStatusProblem_`, `motorStatusCommsError_` and `motorMessageText_` if `doPoll` returned `asynSuccess`
|
||||||
- Run `callParamCallbacks`
|
- Run `callParamCallbacks`
|
||||||
- Return the status of `doPoll`
|
- Return the status of `doPoll`
|
||||||
|
- `motorPosition`: Returns the parameter library value of the motor position, accounted for the motor record resolution (see section "Motor record resolution MRES")
|
||||||
|
- `setMotorPosition`: Writes the given value into the parameter library, accounted for the motor record resolution (see section "Motor record resolution MRES")
|
||||||
- `setVeloFields`: Populates the motor record fields VELO (actual velocity), VBAS (minimum allowed velocity) and VMAX (maximum allowed velocity) from the driver.
|
- `setVeloFields`: Populates the motor record fields VELO (actual velocity), VBAS (minimum allowed velocity) and VMAX (maximum allowed velocity) from the driver.
|
||||||
- `setAcclField`: Populates the motor record field ACCL from the driver.
|
- `setAcclField`: Populates the motor record field ACCL from the driver.
|
||||||
- `startMovTimeoutWatchdog`: Starts a watchdog for the movement time. This watchdog compares the actual time spent in a movement operation with an expected time, which is calculated based on the distance of the current and the target position.
|
- `startMovTimeoutWatchdog`: Starts a watchdog for the movement time. This watchdog compares the actual time spent in a movement operation with an expected time, which is calculated based on the distance of the current and the target position.
|
||||||
|
@ -23,7 +23,10 @@
|
|||||||
# greater than RDBD, the motor will try again, as if the user had requested a
|
# greater than RDBD, the motor will try again, as if the user had requested a
|
||||||
# move from the now current position to the desired position. Only a limited
|
# move from the now current position to the desired position. Only a limited
|
||||||
# number of retries will be performed (see RTRY). If the given value is smaller
|
# number of retries will be performed (see RTRY). If the given value is smaller
|
||||||
# than MRES, it is set to MRES.
|
# than MRES, it is set to MRES. In this version of the record, we set RDBD to a
|
||||||
|
# very high value in order to suppress both retries and the NTM (new target
|
||||||
|
# monitor) logic from issuing stop commands during overshoots (see
|
||||||
|
# https://epics.anl.gov/bcda/synApps/motor/motorRecord.html#Fields_misc).
|
||||||
record(motor,"$(INSTR)$(M)")
|
record(motor,"$(INSTR)$(M)")
|
||||||
{
|
{
|
||||||
field(DESC,"$(DESC=$(M))")
|
field(DESC,"$(DESC=$(M))")
|
||||||
@ -34,21 +37,33 @@ record(motor,"$(INSTR)$(M)")
|
|||||||
field(EGU,"$(EGU)")
|
field(EGU,"$(EGU)")
|
||||||
field(INIT,"")
|
field(INIT,"")
|
||||||
field(PINI,"NO")
|
field(PINI,"NO")
|
||||||
|
field(DHLM, "$(DHLM=0)")
|
||||||
|
field(DLLM, "$(DLLM=0)")
|
||||||
field(TWV,"1")
|
field(TWV,"1")
|
||||||
field(RTRY,"0")
|
field(RTRY,"0")
|
||||||
field(RDBD,"0")
|
field(RDBD, "$(RDBD=10e300)") # Suppress retries and overshoot stop commands
|
||||||
field(BDST,"0")
|
field(BDST, "0")
|
||||||
field(RMOD,"3") # Retry mode 3 ("In-Position"): This suppresses any retries from the motor record.
|
field(RMOD,"3") # Retry mode 3 ("In-Position"): This suppresses any retries from the motor record.
|
||||||
}
|
}
|
||||||
|
|
||||||
# This PV reads out the 10th bit of the MSTA field of the motor record, which
|
# This PV reads out the 10th bit of the MSTA field of the motor record, which
|
||||||
# is the "motorStatusProblem_" bit. The 10th bit is adressed by 0x0200. If the
|
# is the "motorStatusProblem_" bit.
|
||||||
# bit is 0, the .VAL field is 0 as well. If the bit is 1, we need to divide by
|
|
||||||
# 512 (=2^9) in order to set the .VAL field to 1 (and not to 512).
|
|
||||||
record(calc, "$(INSTR)$(M):StatusProblem")
|
record(calc, "$(INSTR)$(M):StatusProblem")
|
||||||
{
|
{
|
||||||
field(INPA, "$(INSTR)$(M).MSTA CP")
|
field(INPA, "$(INSTR)$(M).MSTA CP")
|
||||||
field(CALC, "(A&0x200)/512")
|
field(CALC, "A >> 9")
|
||||||
|
}
|
||||||
|
|
||||||
|
# If the value of this PV is 0, the according axis is currently disconnected from the controller.
|
||||||
|
# Trying to give commands to a disconnected axis will result in an error message in the IOC shell
|
||||||
|
# This record is coupled to the parameter library via motorConnected_ -> MOTOR_CONNECTED.
|
||||||
|
record(longin, "$(INSTR)$(M):Connected")
|
||||||
|
{
|
||||||
|
field(DTYP, "asynInt32")
|
||||||
|
field(INP, "@asyn($(CONTROLLER),$(AXIS)) MOTOR_CONNECTED")
|
||||||
|
field(SCAN, "I/O Intr")
|
||||||
|
field(PINI, "NO")
|
||||||
|
field(VAL, "1")
|
||||||
}
|
}
|
||||||
|
|
||||||
# Call the reset function of the corresponding sinqAxis
|
# Call the reset function of the corresponding sinqAxis
|
||||||
@ -71,7 +86,7 @@ record(longin, "$(INSTR)$(M):StopRBV")
|
|||||||
field(FLNK, "$(INSTR)$(M):Stop2Field")
|
field(FLNK, "$(INSTR)$(M):Stop2Field")
|
||||||
}
|
}
|
||||||
record(longout, "$(INSTR)$(M):Stop2Field") {
|
record(longout, "$(INSTR)$(M):Stop2Field") {
|
||||||
field(DOL, "$(INSTR)$(M):StopRBV CP")
|
field(DOL, "$(INSTR)$(M):StopRBV NPP")
|
||||||
field(OUT, "$(INSTR)$(M).STOP")
|
field(OUT, "$(INSTR)$(M).STOP")
|
||||||
field(OMSL, "closed_loop")
|
field(OMSL, "closed_loop")
|
||||||
}
|
}
|
||||||
@ -82,7 +97,7 @@ record(longout, "$(INSTR)$(M):Stop2Field") {
|
|||||||
# for calculating the estimated time of arrival inside the watchdog).
|
# for calculating the estimated time of arrival inside the watchdog).
|
||||||
record(ao,"$(INSTR)$(M):RecResolution") {
|
record(ao,"$(INSTR)$(M):RecResolution") {
|
||||||
field(DESC, "$(M) resolution")
|
field(DESC, "$(M) resolution")
|
||||||
field(DOL, "$(INSTR)$(M).MRES CP MS")
|
field(DOL, "$(INSTR)$(M).MRES CP")
|
||||||
field(OMSL, "closed_loop")
|
field(OMSL, "closed_loop")
|
||||||
field(DTYP, "asynFloat64")
|
field(DTYP, "asynFloat64")
|
||||||
field(OUT, "@asyn($(CONTROLLER),$(AXIS)) MOTOR_REC_RESOLUTION")
|
field(OUT, "@asyn($(CONTROLLER),$(AXIS)) MOTOR_REC_RESOLUTION")
|
||||||
@ -142,6 +157,18 @@ record(longout, "$(INSTR)$(M):CanSetSpeed") {
|
|||||||
field(VAL, "$(CANSETSPEED=0)")
|
field(VAL, "$(CANSETSPEED=0)")
|
||||||
}
|
}
|
||||||
|
|
||||||
|
# If this PV has a value other than 0, adaptive polling for this axis is enabled.
|
||||||
|
# The standard motor record behaviour is to poll all axis with the busy / move poll
|
||||||
|
# period if at least one of the axes is moving. Adaptive polling changes this so
|
||||||
|
# that only axes which were moving in the last poll are polled with the busy / move poll
|
||||||
|
# period and all other axes are polled with the idle poll period.
|
||||||
|
record(longout, "$(INSTR)$(M):AdaptivePolling") {
|
||||||
|
field(DTYP, "asynInt32")
|
||||||
|
field(OUT, "@asyn($(CONTROLLER),$(AXIS),1) ADAPTIVE_POLLING")
|
||||||
|
field(PINI, "YES")
|
||||||
|
field(VAL, "$(ADAPTPOLL=1)")
|
||||||
|
}
|
||||||
|
|
||||||
# The timeout mechanism for movements can be enabled / disabled by setting
|
# The timeout mechanism for movements can be enabled / disabled by setting
|
||||||
# this PV to 1 / 0.
|
# this PV to 1 / 0.
|
||||||
# This record is coupled to the parameter library via motorEnableMovWatchdog -> MOTOR_ENABLE_MOV_WATCHDOG.
|
# This record is coupled to the parameter library via motorEnableMovWatchdog -> MOTOR_ENABLE_MOV_WATCHDOG.
|
||||||
@ -175,14 +202,17 @@ record(ao, "$(INSTR)$(M):LimitsOffset") {
|
|||||||
record(ai, "$(INSTR)$(M):DHLM_RBV")
|
record(ai, "$(INSTR)$(M):DHLM_RBV")
|
||||||
{
|
{
|
||||||
field(DTYP, "asynFloat64")
|
field(DTYP, "asynFloat64")
|
||||||
|
field(VAL, "$(DHLM=0)")
|
||||||
field(INP, "@asyn($(CONTROLLER),$(AXIS)) MOTOR_HIGH_LIMIT_FROM_DRIVER")
|
field(INP, "@asyn($(CONTROLLER),$(AXIS)) MOTOR_HIGH_LIMIT_FROM_DRIVER")
|
||||||
field(SCAN, "I/O Intr")
|
field(SCAN, "I/O Intr")
|
||||||
field(FLNK, "$(INSTR)$(M):PushDHLM2Field")
|
field(FLNK, "$(INSTR)$(M):PushDHLM2Field")
|
||||||
|
field(PINI, "NO")
|
||||||
}
|
}
|
||||||
record(ao, "$(INSTR)$(M):PushDHLM2Field") {
|
record(ao, "$(INSTR)$(M):PushDHLM2Field") {
|
||||||
field(DOL, "$(INSTR)$(M):DHLM_RBV CP")
|
field(DOL, "$(INSTR)$(M):DHLM_RBV NPP")
|
||||||
field(OUT, "$(INSTR)$(M).DHLM")
|
field(OUT, "$(INSTR)$(M).DHLM")
|
||||||
field(OMSL, "closed_loop")
|
field(OMSL, "closed_loop")
|
||||||
|
field(PINI, "NO")
|
||||||
}
|
}
|
||||||
|
|
||||||
# This record pair reads the parameter library value for "motorLowLimitFromDriver_"
|
# This record pair reads the parameter library value for "motorLowLimitFromDriver_"
|
||||||
@ -193,14 +223,17 @@ record(ao, "$(INSTR)$(M):PushDHLM2Field") {
|
|||||||
record(ai, "$(INSTR)$(M):DLLM_RBV")
|
record(ai, "$(INSTR)$(M):DLLM_RBV")
|
||||||
{
|
{
|
||||||
field(DTYP, "asynFloat64")
|
field(DTYP, "asynFloat64")
|
||||||
|
field(VAL, "$(DLLM=0)")
|
||||||
field(INP, "@asyn($(CONTROLLER),$(AXIS)) MOTOR_LOW_LIMIT_FROM_DRIVER")
|
field(INP, "@asyn($(CONTROLLER),$(AXIS)) MOTOR_LOW_LIMIT_FROM_DRIVER")
|
||||||
field(SCAN, "I/O Intr")
|
field(SCAN, "I/O Intr")
|
||||||
field(FLNK, "$(INSTR)$(M):PushDLLM2Field")
|
field(FLNK, "$(INSTR)$(M):PushDLLM2Field")
|
||||||
|
field(PINI, "NO")
|
||||||
}
|
}
|
||||||
record(ao, "$(INSTR)$(M):PushDLLM2Field") {
|
record(ao, "$(INSTR)$(M):PushDLLM2Field") {
|
||||||
field(DOL, "$(INSTR)$(M):DLLM_RBV CP")
|
field(DOL, "$(INSTR)$(M):DLLM_RBV NPP")
|
||||||
field(OUT, "$(INSTR)$(M).DLLM")
|
field(OUT, "$(INSTR)$(M).DLLM")
|
||||||
field(OMSL, "closed_loop")
|
field(OMSL, "closed_loop")
|
||||||
|
field(PINI, "NO")
|
||||||
}
|
}
|
||||||
|
|
||||||
# This record pair reads the parameter library value for "motorVeloFromDriver_"
|
# This record pair reads the parameter library value for "motorVeloFromDriver_"
|
||||||
@ -216,7 +249,7 @@ record(ai, "$(INSTR)$(M):VELO_RBV")
|
|||||||
field(FLNK, "$(INSTR)$(M):PushVELO2Field")
|
field(FLNK, "$(INSTR)$(M):PushVELO2Field")
|
||||||
}
|
}
|
||||||
record(ao, "$(INSTR)$(M):PushVELO2Field") {
|
record(ao, "$(INSTR)$(M):PushVELO2Field") {
|
||||||
field(DOL, "$(INSTR)$(M):VELO_RBV CP")
|
field(DOL, "$(INSTR)$(M):VELO_RBV NPP")
|
||||||
field(OUT, "$(INSTR)$(M).VELO")
|
field(OUT, "$(INSTR)$(M).VELO")
|
||||||
field(OMSL, "closed_loop")
|
field(OMSL, "closed_loop")
|
||||||
}
|
}
|
||||||
@ -234,7 +267,7 @@ record(ai, "$(INSTR)$(M):VBAS_RBV")
|
|||||||
field(FLNK, "$(INSTR)$(M):PushVBAS2Field")
|
field(FLNK, "$(INSTR)$(M):PushVBAS2Field")
|
||||||
}
|
}
|
||||||
record(ao, "$(INSTR)$(M):PushVBAS2Field") {
|
record(ao, "$(INSTR)$(M):PushVBAS2Field") {
|
||||||
field(DOL, "$(INSTR)$(M):VBAS_RBV CP")
|
field(DOL, "$(INSTR)$(M):VBAS_RBV NPP")
|
||||||
field(OUT, "$(INSTR)$(M).VBAS")
|
field(OUT, "$(INSTR)$(M).VBAS")
|
||||||
field(OMSL, "closed_loop")
|
field(OMSL, "closed_loop")
|
||||||
}
|
}
|
||||||
@ -252,7 +285,7 @@ record(ai, "$(INSTR)$(M):VMAX_RBV")
|
|||||||
field(FLNK, "$(INSTR)$(M):PushVMAX2Field")
|
field(FLNK, "$(INSTR)$(M):PushVMAX2Field")
|
||||||
}
|
}
|
||||||
record(ao, "$(INSTR)$(M):PushVMAX2Field") {
|
record(ao, "$(INSTR)$(M):PushVMAX2Field") {
|
||||||
field(DOL, "$(INSTR)$(M):VMAX_RBV CP")
|
field(DOL, "$(INSTR)$(M):VMAX_RBV NPP")
|
||||||
field(OUT, "$(INSTR)$(M).VMAX")
|
field(OUT, "$(INSTR)$(M).VMAX")
|
||||||
field(OMSL, "closed_loop")
|
field(OMSL, "closed_loop")
|
||||||
}
|
}
|
||||||
@ -270,7 +303,7 @@ record(ai, "$(INSTR)$(M):ACCL_RBV")
|
|||||||
field(FLNK, "$(INSTR)$(M):PushACCL2Field")
|
field(FLNK, "$(INSTR)$(M):PushACCL2Field")
|
||||||
}
|
}
|
||||||
record(ao, "$(INSTR)$(M):PushACCL2Field") {
|
record(ao, "$(INSTR)$(M):PushACCL2Field") {
|
||||||
field(DOL, "$(INSTR)$(M):ACCL_RBV CP")
|
field(DOL, "$(INSTR)$(M):ACCL_RBV NPP")
|
||||||
field(OUT, "$(INSTR)$(M).ACCL")
|
field(OUT, "$(INSTR)$(M).ACCL")
|
||||||
field(OMSL, "closed_loop")
|
field(OMSL, "closed_loop")
|
||||||
}
|
}
|
||||||
|
@ -2,11 +2,13 @@
|
|||||||
#include <unordered_map>
|
#include <unordered_map>
|
||||||
|
|
||||||
msgPrintControlKey::msgPrintControlKey(char *controller, int axisNo,
|
msgPrintControlKey::msgPrintControlKey(char *controller, int axisNo,
|
||||||
const char *functionName, int line) {
|
const char *functionName, int line,
|
||||||
|
size_t maxRepetitions) {
|
||||||
controller_ = controller;
|
controller_ = controller;
|
||||||
axisNo_ = axisNo;
|
axisNo_ = axisNo;
|
||||||
line_ = line;
|
line_ = line;
|
||||||
functionName_ = functionName;
|
functionName_ = functionName;
|
||||||
|
maxRepetitions_ = maxRepetitions;
|
||||||
}
|
}
|
||||||
|
|
||||||
void msgPrintControlKey::format(char *buffer, size_t bufferSize) {
|
void msgPrintControlKey::format(char *buffer, size_t bufferSize) {
|
||||||
@ -16,10 +18,6 @@ void msgPrintControlKey::format(char *buffer, size_t bufferSize) {
|
|||||||
|
|
||||||
// =============================================================================
|
// =============================================================================
|
||||||
|
|
||||||
msgPrintControl::msgPrintControl(size_t maxRepetitions) {
|
|
||||||
maxRepetitions_ = maxRepetitions;
|
|
||||||
}
|
|
||||||
|
|
||||||
bool msgPrintControl::shouldBePrinted(msgPrintControlKey &key, bool wantToPrint,
|
bool msgPrintControl::shouldBePrinted(msgPrintControlKey &key, bool wantToPrint,
|
||||||
asynUser *pasynUser) {
|
asynUser *pasynUser) {
|
||||||
|
|
||||||
@ -34,12 +32,12 @@ bool msgPrintControl::shouldBePrinted(msgPrintControlKey &key, bool wantToPrint,
|
|||||||
*/
|
*/
|
||||||
if (map_.find(key) != map_.end()) {
|
if (map_.find(key) != map_.end()) {
|
||||||
size_t repetitions = map_[key];
|
size_t repetitions = map_[key];
|
||||||
if (repetitions < maxRepetitions_) {
|
if (repetitions < key.maxRepetitions_) {
|
||||||
// Number of allowed repetitions not exceeded -> Printing the
|
// Number of allowed repetitions not exceeded -> Printing the
|
||||||
// message is ok.
|
// message is ok.
|
||||||
map_[key] = repetitions + 1;
|
map_[key] = repetitions + 1;
|
||||||
return true;
|
return true;
|
||||||
} else if (repetitions == maxRepetitions_) {
|
} else if (repetitions == key.maxRepetitions_) {
|
||||||
// Reached number of allowed repetitions -> Printing the message
|
// Reached number of allowed repetitions -> Printing the message
|
||||||
// is ok, but further trys are rejected.
|
// is ok, but further trys are rejected.
|
||||||
char formattedKey[100] = {0};
|
char formattedKey[100] = {0};
|
||||||
@ -88,7 +86,8 @@ bool msgPrintControl::shouldBePrinted(msgPrintControlKey &key, bool wantToPrint,
|
|||||||
|
|
||||||
bool msgPrintControl::shouldBePrinted(char *portName, int axisNo,
|
bool msgPrintControl::shouldBePrinted(char *portName, int axisNo,
|
||||||
const char *functionName, int line,
|
const char *functionName, int line,
|
||||||
bool wantToPrint, asynUser *pasynUser) {
|
bool wantToPrint, asynUser *pasynUser,
|
||||||
|
size_t maxRepetitions) {
|
||||||
msgPrintControlKey key =
|
msgPrintControlKey key =
|
||||||
msgPrintControlKey(portName, axisNo, functionName, __LINE__);
|
msgPrintControlKey(portName, axisNo, functionName, __LINE__);
|
||||||
return shouldBePrinted(key, wantToPrint, pasynUser);
|
return shouldBePrinted(key, wantToPrint, pasynUser);
|
||||||
|
@ -1,6 +1,8 @@
|
|||||||
#ifndef msgPrintControl_H
|
#ifndef msgPrintControl_H
|
||||||
#define msgPrintControl_H
|
#define msgPrintControl_H
|
||||||
|
|
||||||
|
#define DefaultMaxRepetitions 4
|
||||||
|
|
||||||
#include <asynDriver.h>
|
#include <asynDriver.h>
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
#include <string>
|
#include <string>
|
||||||
@ -14,13 +16,22 @@
|
|||||||
class msgPrintControlKey {
|
class msgPrintControlKey {
|
||||||
public:
|
public:
|
||||||
std::string controller_;
|
std::string controller_;
|
||||||
// -1 is a non-axis specific message
|
|
||||||
|
// -1 indicates a non-axis specific message
|
||||||
int axisNo_;
|
int axisNo_;
|
||||||
|
|
||||||
const char *functionName_;
|
const char *functionName_;
|
||||||
int line_;
|
int line_;
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Maximum number of times a message is printed before it is
|
||||||
|
* suppressed. This number is not used as part of the hash.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
size_t maxRepetitions_;
|
||||||
|
|
||||||
msgPrintControlKey(char *controller_, int axisNo, const char *fileName,
|
msgPrintControlKey(char *controller_, int axisNo, const char *fileName,
|
||||||
int line);
|
int line, size_t maxRepetitions = DefaultMaxRepetitions);
|
||||||
|
|
||||||
bool operator==(const msgPrintControlKey &other) const {
|
bool operator==(const msgPrintControlKey &other) const {
|
||||||
return axisNo_ == other.axisNo_ && line_ == other.line_ &&
|
return axisNo_ == other.axisNo_ && line_ == other.line_ &&
|
||||||
@ -32,7 +43,7 @@ class msgPrintControlKey {
|
|||||||
};
|
};
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Implementation of the hash functionality for msgPrintControlKey
|
* @brief Implementation of the hash functionality for `msgPrintControlKey`
|
||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
namespace std {
|
namespace std {
|
||||||
@ -57,7 +68,7 @@ template <> struct hash<msgPrintControlKey> {
|
|||||||
* axis fails, a corresponding error message is created in each poll. This
|
* axis fails, a corresponding error message is created in each poll. This
|
||||||
* could "flood" the IOC shell with noise. To prevent this, this class keeps
|
* could "flood" the IOC shell with noise. To prevent this, this class keeps
|
||||||
* track of the number of subsequent error message repetition. Each message is
|
* track of the number of subsequent error message repetition. Each message is
|
||||||
* uniquely identified by "msgPrintControlKey". The function shouldBePrinted
|
* uniquely identified by `msgPrintControlKey`. The function `shouldBePrinted`
|
||||||
* can be used in order to see if a message should be printed or not:
|
* can be used in order to see if a message should be printed or not:
|
||||||
*
|
*
|
||||||
* ```
|
* ```
|
||||||
@ -67,26 +78,23 @@ template <> struct hash<msgPrintControlKey> {
|
|||||||
* if (msgPrintControl.shouldBePrinted(controller, axisNo, __PRETTY_FUNCTION__,
|
* if (msgPrintControl.shouldBePrinted(controller, axisNo, __PRETTY_FUNCTION__,
|
||||||
* __LINE__, wantToPrint)) { asynPrint(...)
|
* __LINE__, wantToPrint)) { asynPrint(...)
|
||||||
* }
|
* }
|
||||||
*
|
|
||||||
* ```
|
* ```
|
||||||
*/
|
*/
|
||||||
class msgPrintControl {
|
class msgPrintControl {
|
||||||
public:
|
public:
|
||||||
msgPrintControl(size_t maxRepetitions);
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Checks if the error message associated with "key" has been printed
|
* @brief Checks if the error message associated with "key" has been printed
|
||||||
* more than "maxRepetitions_" times in a row. If yes, returns false,
|
* more than `this->maxRepetitions_` times in a row. If yes, returns false,
|
||||||
* otherwise true. Counter is reset if wantToPrint is false.
|
* otherwise true. Counter is reset if `wantToPrint` is false.
|
||||||
*
|
*
|
||||||
* If the conditions for printing a message are met, "wantToPrint" must be
|
* If the conditions for printing a message are met, `wantToPrint` must be
|
||||||
* set to true. The function then checks if "maxRepetitions_" has been
|
* set to true. The function then checks if `maxRepetitions_` has been
|
||||||
* exceeded. If yes, the function returns no, indicating that the message
|
* exceeded. If yes, the function returns no, indicating that the message
|
||||||
* should not be printed. If no, the number of repetitions stored in the map
|
* should not be printed. If no, the number of repetitions stored in the map
|
||||||
* is incremented and the function returns true, indicating that the message
|
* is incremented and the function returns true, indicating that the message
|
||||||
* should be printed.
|
* should be printed.
|
||||||
*
|
*
|
||||||
* If the conditions for printing a message are not met, "wantToPrint" must
|
* If the conditions for printing a message are not met, `wantToPrint` must
|
||||||
* be set to false. This resets the map entry.
|
* be set to false. This resets the map entry.
|
||||||
*
|
*
|
||||||
* @param key Key associated with the message, used to
|
* @param key Key associated with the message, used to
|
||||||
@ -114,27 +122,21 @@ class msgPrintControl {
|
|||||||
* @param pasynUser
|
* @param pasynUser
|
||||||
*/
|
*/
|
||||||
bool shouldBePrinted(char *controller, int axisNo, const char *functionName,
|
bool shouldBePrinted(char *controller, int axisNo, const char *functionName,
|
||||||
int line, bool wantToPrint, asynUser *pasynUser);
|
int line, bool wantToPrint, asynUser *pasynUser,
|
||||||
|
size_t maxRepetitions = DefaultMaxRepetitions);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Reset the error message count incremented in shouldBePrinted for
|
* @brief Reset the error message count incremented in `shouldBePrinted` for
|
||||||
* the given key
|
* the given key
|
||||||
*
|
*
|
||||||
* @param key Key associated with the message, used to
|
* @param key Key associated with the message, used to
|
||||||
* identify individual messages
|
* identify individual messages
|
||||||
* @param pasynUser If the problem has been resolved (wantToPrint =
|
* @param pasynUser If the problem has been resolved (`wantToPrint =
|
||||||
* false), a corresponding status message is printed using the given
|
* false`), a corresponding status message is printed using the given
|
||||||
* asynUser. If this pointer is a nullptr, no message is printed.
|
* asynUser. If this pointer is a nullptr, no message is printed.
|
||||||
*/
|
*/
|
||||||
void resetCount(msgPrintControlKey &key, asynUser *pasynUser);
|
void resetCount(msgPrintControlKey &key, asynUser *pasynUser);
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief Maximum number of times a message is printed before it is
|
|
||||||
* suppressed.
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
size_t maxRepetitions_;
|
|
||||||
|
|
||||||
char *getSuffix();
|
char *getSuffix();
|
||||||
|
|
||||||
private:
|
private:
|
||||||
|
305
src/sinqAxis.cpp
305
src/sinqAxis.cpp
@ -14,13 +14,16 @@ sinqAxis::sinqAxis(class sinqController *pC, int axisNo)
|
|||||||
scaleMovTimeout_ = 2.0;
|
scaleMovTimeout_ = 2.0;
|
||||||
offsetMovTimeout_ = 30;
|
offsetMovTimeout_ = 30;
|
||||||
targetPosition_ = 0.0;
|
targetPosition_ = 0.0;
|
||||||
|
wasMoving_ = false;
|
||||||
|
|
||||||
|
epicsTimeGetCurrent(&lastPollTime_);
|
||||||
|
|
||||||
// This check is also done in asynMotorAxis, but there the IOC continues
|
// This check is also done in asynMotorAxis, but there the IOC continues
|
||||||
// running even though the configuration is incorrect. When failing this
|
// running even though the configuration is incorrect. When failing this
|
||||||
// check, the IOC is stopped, since this is definitely a configuration
|
// check, the IOC is stopped, since this is definitely a configuration
|
||||||
// problem.
|
// problem.
|
||||||
if ((axisNo < 0) || (axisNo >= pC->numAxes())) {
|
if ((axisNo < 0) || (axisNo >= pC->numAxes())) {
|
||||||
asynPrint(pC_->asynUserSelf(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
||||||
"(axis index %d is not in range 0 to %d)\n. Terminating IOC",
|
"(axis index %d is not in range 0 to %d)\n. Terminating IOC",
|
||||||
pC->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, axisNo,
|
pC->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, axisNo,
|
||||||
@ -31,7 +34,7 @@ sinqAxis::sinqAxis(class sinqController *pC, int axisNo)
|
|||||||
// Motor is assumed to be enabled
|
// Motor is assumed to be enabled
|
||||||
status = setIntegerParam(pC_->motorEnableRBV(), 1);
|
status = setIntegerParam(pC_->motorEnableRBV(), 1);
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
asynPrint(pC_->asynUserSelf(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
||||||
"(setting a parameter value failed "
|
"(setting a parameter value failed "
|
||||||
"with %s)\n. Terminating IOC",
|
"with %s)\n. Terminating IOC",
|
||||||
@ -43,7 +46,7 @@ sinqAxis::sinqAxis(class sinqController *pC, int axisNo)
|
|||||||
// By default, motors cannot be disabled
|
// By default, motors cannot be disabled
|
||||||
status = setIntegerParam(pC_->motorCanDisable(), 0);
|
status = setIntegerParam(pC_->motorCanDisable(), 0);
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
asynPrint(pC_->asynUserSelf(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
||||||
"(setting a parameter value failed "
|
"(setting a parameter value failed "
|
||||||
"with %s)\n. Terminating IOC",
|
"with %s)\n. Terminating IOC",
|
||||||
@ -55,7 +58,19 @@ sinqAxis::sinqAxis(class sinqController *pC, int axisNo)
|
|||||||
// Provide a default value for the motor position.
|
// Provide a default value for the motor position.
|
||||||
status = setDoubleParam(pC_->motorPosition(), 0.0);
|
status = setDoubleParam(pC_->motorPosition(), 0.0);
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
asynPrint(pC_->asynUserSelf(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
|
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
||||||
|
"(setting a parameter value failed "
|
||||||
|
"with %s)\n. Terminating IOC",
|
||||||
|
pC->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
|
||||||
|
pC_->stringifyAsynStatus(status));
|
||||||
|
exit(-1);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Assume that the motor is connected initially
|
||||||
|
status = setIntegerParam(pC_->motorConnected(), 1);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
||||||
"(setting a parameter value failed "
|
"(setting a parameter value failed "
|
||||||
"with %s)\n. Terminating IOC",
|
"with %s)\n. Terminating IOC",
|
||||||
@ -67,7 +82,7 @@ sinqAxis::sinqAxis(class sinqController *pC, int axisNo)
|
|||||||
// We assume that the motor has no status problems initially
|
// We assume that the motor has no status problems initially
|
||||||
status = setIntegerParam(pC_->motorStatusProblem(), 0);
|
status = setIntegerParam(pC_->motorStatusProblem(), 0);
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
asynPrint(pC_->asynUserSelf(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
||||||
"(setting a parameter value failed "
|
"(setting a parameter value failed "
|
||||||
"with %s)\n. Terminating IOC",
|
"with %s)\n. Terminating IOC",
|
||||||
@ -79,7 +94,7 @@ sinqAxis::sinqAxis(class sinqController *pC, int axisNo)
|
|||||||
// Set the homing-related flags
|
// Set the homing-related flags
|
||||||
status = setIntegerParam(pC_->motorStatusHome(), 0);
|
status = setIntegerParam(pC_->motorStatusHome(), 0);
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
asynPrint(pC_->asynUserSelf(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
||||||
"(setting a parameter value failed "
|
"(setting a parameter value failed "
|
||||||
"with %s)\n. Terminating IOC",
|
"with %s)\n. Terminating IOC",
|
||||||
@ -89,7 +104,7 @@ sinqAxis::sinqAxis(class sinqController *pC, int axisNo)
|
|||||||
}
|
}
|
||||||
status = setIntegerParam(pC_->motorStatusHomed(), 0);
|
status = setIntegerParam(pC_->motorStatusHomed(), 0);
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
asynPrint(pC_->asynUserSelf(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
||||||
"(setting a parameter value failed "
|
"(setting a parameter value failed "
|
||||||
"with %s)\n. Terminating IOC",
|
"with %s)\n. Terminating IOC",
|
||||||
@ -99,7 +114,7 @@ sinqAxis::sinqAxis(class sinqController *pC, int axisNo)
|
|||||||
}
|
}
|
||||||
status = setIntegerParam(pC_->motorStatusAtHome(), 0);
|
status = setIntegerParam(pC_->motorStatusAtHome(), 0);
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
asynPrint(pC_->asynUserSelf(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
"Controller \"%s\", axis %d => %s, line %d:\nFATAL ERROR "
|
||||||
"(setting a parameter value failed "
|
"(setting a parameter value failed "
|
||||||
"with %s)\n. Terminating IOC",
|
"with %s)\n. Terminating IOC",
|
||||||
@ -110,11 +125,53 @@ sinqAxis::sinqAxis(class sinqController *pC, int axisNo)
|
|||||||
}
|
}
|
||||||
|
|
||||||
asynStatus sinqAxis::poll(bool *moving) {
|
asynStatus sinqAxis::poll(bool *moving) {
|
||||||
|
|
||||||
// Local variable declaration
|
// Local variable declaration
|
||||||
asynStatus pl_status = asynSuccess;
|
asynStatus pl_status = asynSuccess;
|
||||||
asynStatus poll_status = asynSuccess;
|
asynStatus poll_status = asynSuccess;
|
||||||
int homing = 0;
|
int homing = 0;
|
||||||
int homed = 0;
|
int homed = 0;
|
||||||
|
int adaptivePolling = 0;
|
||||||
|
|
||||||
|
/*
|
||||||
|
If adaptive polling is enabled:
|
||||||
|
- Check if the motor was moving during the last poll
|
||||||
|
- If yes, perform the poll
|
||||||
|
- If no, check if the last poll was at least an idlePollPeriod ago
|
||||||
|
- If yes, perform the poll
|
||||||
|
- If no, skip it
|
||||||
|
*/
|
||||||
|
|
||||||
|
pl_status =
|
||||||
|
pC_->getIntegerParam(axisNo_, pC_->adaptivePolling(), &adaptivePolling);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "adaptivePolling", axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
};
|
||||||
|
|
||||||
|
// Using the EPICS timestamp here, see
|
||||||
|
// https://docs.epics-controls.org/projects/base/en/latest/epicsTime_h.html#_CPPv414epicsTimeStamp
|
||||||
|
|
||||||
|
// Get the current time
|
||||||
|
epicsTimeStamp ts;
|
||||||
|
epicsTimeGetCurrent(&ts);
|
||||||
|
|
||||||
|
if (adaptivePolling != 0) {
|
||||||
|
// Motor wasn't moving during the last poll
|
||||||
|
if (!wasMoving_) {
|
||||||
|
|
||||||
|
// Add the idle poll period
|
||||||
|
epicsTimeStamp earliestTimeNextPoll = lastPollTime_;
|
||||||
|
epicsTimeAddSeconds(&earliestTimeNextPoll, pC_->idlePollPeriod());
|
||||||
|
|
||||||
|
if (epicsTimeLessThanEqual(&earliestTimeNextPoll, &ts) == 0) {
|
||||||
|
*moving = false;
|
||||||
|
return asynSuccess;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
// Update the start time of the last poll
|
||||||
|
lastPollTime_ = ts;
|
||||||
|
|
||||||
/*
|
/*
|
||||||
At the beginning of the poll, it is assumed that the axis has no status
|
At the beginning of the poll, it is assumed that the axis has no status
|
||||||
@ -146,6 +203,9 @@ asynStatus sinqAxis::poll(bool *moving) {
|
|||||||
// return.
|
// return.
|
||||||
poll_status = doPoll(moving);
|
poll_status = doPoll(moving);
|
||||||
|
|
||||||
|
// Motor was moving during this poll
|
||||||
|
wasMoving_ = *moving;
|
||||||
|
|
||||||
// The poll did not succeed: Something went wrong and the motor has a status
|
// The poll did not succeed: Something went wrong and the motor has a status
|
||||||
// problem.
|
// problem.
|
||||||
if (poll_status != asynSuccess) {
|
if (poll_status != asynSuccess) {
|
||||||
@ -202,8 +262,8 @@ asynStatus sinqAxis::poll(bool *moving) {
|
|||||||
bool wantToPrint = pl_status != asynSuccess;
|
bool wantToPrint = pl_status != asynSuccess;
|
||||||
if (pC_->getMsgPrintControl().shouldBePrinted(
|
if (pC_->getMsgPrintControl().shouldBePrinted(
|
||||||
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, wantToPrint,
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__, wantToPrint,
|
||||||
pC_->asynUserSelf())) {
|
pC_->pasynUser())) {
|
||||||
asynPrint(pC_->asynUserSelf(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line "
|
"Controller \"%s\", axis %d => %s, line "
|
||||||
"%d:\ncallParamCallbacks failed with %s.%s\n",
|
"%d:\ncallParamCallbacks failed with %s.%s\n",
|
||||||
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
|
||||||
@ -223,36 +283,47 @@ asynStatus sinqAxis::move(double position, int relative, double minVelocity,
|
|||||||
double maxVelocity, double acceleration) {
|
double maxVelocity, double acceleration) {
|
||||||
|
|
||||||
// Status of parameter library operations
|
// Status of parameter library operations
|
||||||
asynStatus pl_status = asynSuccess;
|
asynStatus status = asynSuccess;
|
||||||
double motorRecResolution = 0.0;
|
double motorRecResolution = 0.0;
|
||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
// When a new move is done, the motor is not homed anymore
|
|
||||||
pl_status = setIntegerParam(pC_->motorStatusHomed(), 0);
|
|
||||||
if (pl_status != asynSuccess) {
|
|
||||||
return pC_->paramLibAccessFailed(pl_status, "motorStatusHomed_",
|
|
||||||
axisNo_, __PRETTY_FUNCTION__,
|
|
||||||
__LINE__);
|
|
||||||
}
|
|
||||||
pl_status = setIntegerParam(pC_->motorStatusAtHome(), 0);
|
|
||||||
if (pl_status != asynSuccess) {
|
|
||||||
return pC_->paramLibAccessFailed(pl_status, "motorStatusAtHome_",
|
|
||||||
axisNo_, __PRETTY_FUNCTION__,
|
|
||||||
__LINE__);
|
|
||||||
}
|
|
||||||
pl_status = pC_->getDoubleParam(axisNo_, pC_->motorRecResolution(),
|
|
||||||
&motorRecResolution);
|
|
||||||
if (pl_status != asynSuccess) {
|
|
||||||
return pC_->paramLibAccessFailed(pl_status, "motorRecResolution_",
|
|
||||||
axisNo_, __PRETTY_FUNCTION__,
|
|
||||||
__LINE__);
|
|
||||||
}
|
|
||||||
|
|
||||||
// Store the target position internally
|
// Store the target position internally
|
||||||
targetPosition_ = position * motorRecResolution;
|
targetPosition_ = position * motorRecResolution;
|
||||||
|
|
||||||
return doMove(position, relative, minVelocity, maxVelocity, acceleration);
|
status = doMove(position, relative, minVelocity, maxVelocity, acceleration);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
|
||||||
|
status = assertConnected();
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Since the move command was successfull, we assume that the motor has
|
||||||
|
// started its movement.
|
||||||
|
status = setIntegerParam(pC_->motorStatusHomed(), 0);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(status, "motorStatusHomed_", axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
status = setIntegerParam(pC_->motorStatusAtHome(), 0);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(status, "motorStatusAtHome_", axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
status = pC_->getDoubleParam(axisNo_, pC_->motorRecResolution(),
|
||||||
|
&motorRecResolution);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(status, "motorRecResolution_", axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Needed for adaptive polling
|
||||||
|
wasMoving_ = true;
|
||||||
|
|
||||||
|
return pC_->callParamCallbacks();
|
||||||
}
|
}
|
||||||
|
|
||||||
asynStatus sinqAxis::doMove(double position, int relative, double minVelocity,
|
asynStatus sinqAxis::doMove(double position, int relative, double minVelocity,
|
||||||
@ -283,6 +354,7 @@ asynStatus sinqAxis::home(double minVelocity, double maxVelocity,
|
|||||||
axisNo_, __PRETTY_FUNCTION__,
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
__LINE__);
|
__LINE__);
|
||||||
}
|
}
|
||||||
|
// Set field ATHM to zero
|
||||||
status = setIntegerParam(pC_->motorStatusHomed(), 0);
|
status = setIntegerParam(pC_->motorStatusHomed(), 0);
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
return pC_->paramLibAccessFailed(status, "motorStatusHomed_",
|
return pC_->paramLibAccessFailed(status, "motorStatusHomed_",
|
||||||
@ -296,6 +368,11 @@ asynStatus sinqAxis::home(double minVelocity, double maxVelocity,
|
|||||||
__LINE__);
|
__LINE__);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
status = assertConnected();
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
|
||||||
// Update the motor record
|
// Update the motor record
|
||||||
return callParamCallbacks();
|
return callParamCallbacks();
|
||||||
|
|
||||||
@ -309,11 +386,16 @@ asynStatus sinqAxis::home(double minVelocity, double maxVelocity,
|
|||||||
__LINE__);
|
__LINE__);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
status = assertConnected();
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
|
||||||
// Update the motor record
|
// Update the motor record
|
||||||
return callParamCallbacks();
|
return callParamCallbacks();
|
||||||
} else {
|
} else {
|
||||||
// Bubble up all other problems
|
// Bubble up all other problems
|
||||||
return status;
|
return assertConnected();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -322,10 +404,99 @@ asynStatus sinqAxis::doHome(double minVelocity, double maxVelocity,
|
|||||||
return asynSuccess;
|
return asynSuccess;
|
||||||
}
|
}
|
||||||
|
|
||||||
asynStatus sinqAxis::reset() { return asynSuccess; }
|
asynStatus sinqAxis::reset() {
|
||||||
|
asynStatus status = doReset();
|
||||||
|
|
||||||
|
if (status == asynSuccess) {
|
||||||
|
// Perform some fast polls
|
||||||
|
pC_->lock();
|
||||||
|
bool moving = false;
|
||||||
|
for (int i = 0; i < 5; i++) {
|
||||||
|
epicsThreadSleep(pC_->movingPollPeriod());
|
||||||
|
if (poll(&moving) == asynSuccess) {
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
pC_->unlock();
|
||||||
|
}
|
||||||
|
|
||||||
|
asynStatus pl_status = assertConnected();
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pl_status;
|
||||||
|
}
|
||||||
|
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
|
||||||
|
asynStatus sinqAxis::doReset() { return asynError; }
|
||||||
|
|
||||||
asynStatus sinqAxis::enable(bool on) { return asynSuccess; }
|
asynStatus sinqAxis::enable(bool on) { return asynSuccess; }
|
||||||
|
|
||||||
|
asynStatus sinqAxis::motorPosition(double *motorPosition) {
|
||||||
|
asynStatus status = asynSuccess;
|
||||||
|
double motorRecResolution = 0.0;
|
||||||
|
|
||||||
|
status = pC_->getDoubleParam(axisNo(), pC_->motorRecResolution(),
|
||||||
|
&motorRecResolution);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(status, "motorRecResolution_",
|
||||||
|
axisNo(), __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
|
status = pC_->getDoubleParam(axisNo(), pC_->motorPosition(), motorPosition);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(status, "motorPosition_", axisNo(),
|
||||||
|
__PRETTY_FUNCTION__,
|
||||||
|
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
*motorPosition = *motorPosition * motorRecResolution;
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
|
||||||
|
asynStatus sinqAxis::setMotorPosition(double motorPosition) {
|
||||||
|
asynStatus status = asynSuccess;
|
||||||
|
double motorRecResolution = 0.0;
|
||||||
|
|
||||||
|
status = pC_->getDoubleParam(axisNo(), pC_->motorRecResolution(),
|
||||||
|
&motorRecResolution);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(status, "motorRecResolution_",
|
||||||
|
axisNo(), __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
|
status = setDoubleParam(pC_->motorPosition(),
|
||||||
|
motorPosition / motorRecResolution);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(status, "motorPosition_", axisNo(),
|
||||||
|
__PRETTY_FUNCTION__,
|
||||||
|
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
|
||||||
|
asynStatus sinqAxis::assertConnected() {
|
||||||
|
asynStatus status = asynSuccess;
|
||||||
|
int connected = 0;
|
||||||
|
|
||||||
|
status = pC_->getIntegerParam(axisNo(), pC_->motorConnected(), &connected);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(status, "motorConnected", axisNo(),
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (connected == 0) {
|
||||||
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
|
"Controller \"%s\", axis %d => %s, line "
|
||||||
|
"%d:\nAxis is not connected, all commands are ignored.\n",
|
||||||
|
pC_->portName, axisNo(), __PRETTY_FUNCTION__, __LINE__);
|
||||||
|
}
|
||||||
|
return asynSuccess;
|
||||||
|
}
|
||||||
|
|
||||||
asynStatus sinqAxis::setVeloFields(double velo, double vbas, double vmax) {
|
asynStatus sinqAxis::setVeloFields(double velo, double vbas, double vmax) {
|
||||||
asynStatus status = asynSuccess;
|
asynStatus status = asynSuccess;
|
||||||
int variableSpeed = 0;
|
int variableSpeed = 0;
|
||||||
@ -341,7 +512,7 @@ asynStatus sinqAxis::setVeloFields(double velo, double vbas, double vmax) {
|
|||||||
|
|
||||||
// Check the inputs and create corresponding error messages
|
// Check the inputs and create corresponding error messages
|
||||||
if (vbas > vmax) {
|
if (vbas > vmax) {
|
||||||
asynPrint(pC_->asynUserSelf(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\nLower speed "
|
"Controller \"%s\", axis %d => %s, line %d:\nLower speed "
|
||||||
"limit vbas=%lf must not be smaller than upper limit "
|
"limit vbas=%lf must not be smaller than upper limit "
|
||||||
"vmax=%lf.\n",
|
"vmax=%lf.\n",
|
||||||
@ -359,7 +530,7 @@ asynStatus sinqAxis::setVeloFields(double velo, double vbas, double vmax) {
|
|||||||
return asynError;
|
return asynError;
|
||||||
}
|
}
|
||||||
if (velo < vbas || velo > vmax) {
|
if (velo < vbas || velo > vmax) {
|
||||||
asynPrint(pC_->asynUserSelf(), ASYN_TRACE_ERROR,
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\nActual "
|
"Controller \"%s\", axis %d => %s, line %d:\nActual "
|
||||||
"speed velo=%lf must be between lower limit vbas=%lf and "
|
"speed velo=%lf must be between lower limit vbas=%lf and "
|
||||||
"upper limit vmax=%lf.\n",
|
"upper limit vmax=%lf.\n",
|
||||||
@ -455,8 +626,7 @@ asynStatus sinqAxis::startMovTimeoutWatchdog() {
|
|||||||
|
|
||||||
if (enableMovWatchdog == 1) {
|
if (enableMovWatchdog == 1) {
|
||||||
// These parameters are only needed in this branch
|
// These parameters are only needed in this branch
|
||||||
double motorPosition = 0.0;
|
double motorPos = 0.0;
|
||||||
double motorPositionRec = 0.0;
|
|
||||||
double motorVelocity = 0.0;
|
double motorVelocity = 0.0;
|
||||||
double motorVelocityRec = 0.0;
|
double motorVelocityRec = 0.0;
|
||||||
double motorAccel = 0.0;
|
double motorAccel = 0.0;
|
||||||
@ -473,24 +643,11 @@ asynStatus sinqAxis::startMovTimeoutWatchdog() {
|
|||||||
to save the read result to the member variable earlier), since the
|
to save the read result to the member variable earlier), since the
|
||||||
parameter library is updated at a later stage!
|
parameter library is updated at a later stage!
|
||||||
*/
|
*/
|
||||||
pl_status = pC_->getDoubleParam(axisNo_, pC_->motorRecResolution(),
|
pl_status = motorPosition(&motorPos);
|
||||||
&motorRecResolution);
|
|
||||||
if (pl_status != asynSuccess) {
|
if (pl_status != asynSuccess) {
|
||||||
return pC_->paramLibAccessFailed(pl_status, "motorRecResolution_",
|
return pl_status;
|
||||||
axisNo_, __PRETTY_FUNCTION__,
|
|
||||||
__LINE__);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
pl_status = pC_->getDoubleParam(axisNo_, pC_->motorPosition(),
|
|
||||||
&motorPositionRec);
|
|
||||||
if (pl_status != asynSuccess) {
|
|
||||||
return pC_->paramLibAccessFailed(pl_status, "motorPosition",
|
|
||||||
axisNo_, __PRETTY_FUNCTION__,
|
|
||||||
__LINE__);
|
|
||||||
}
|
|
||||||
|
|
||||||
motorPosition = motorPositionRec * motorRecResolution;
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
We use motorVelocity, which corresponds to the record field VELO.
|
We use motorVelocity, which corresponds to the record field VELO.
|
||||||
From https://epics.anl.gov/docs/APS2015/14-Motor-Record.pdf:
|
From https://epics.anl.gov/docs/APS2015/14-Motor-Record.pdf:
|
||||||
@ -503,6 +660,13 @@ asynStatus sinqAxis::startMovTimeoutWatchdog() {
|
|||||||
= VELO / MRES motorAccel = (motorVelocity - motorVelBase) / ACCL
|
= VELO / MRES motorAccel = (motorVelocity - motorVelBase) / ACCL
|
||||||
Therefore, we need to correct the values from the parameter library.
|
Therefore, we need to correct the values from the parameter library.
|
||||||
*/
|
*/
|
||||||
|
pl_status = pC_->getDoubleParam(axisNo_, pC_->motorRecResolution(),
|
||||||
|
&motorRecResolution);
|
||||||
|
if (pl_status != asynSuccess) {
|
||||||
|
return pC_->paramLibAccessFailed(pl_status, "motorRecResolution_",
|
||||||
|
axisNo_, __PRETTY_FUNCTION__,
|
||||||
|
__LINE__);
|
||||||
|
}
|
||||||
|
|
||||||
// Read the velocity
|
// Read the velocity
|
||||||
pl_status = pC_->getDoubleParam(axisNo_, pC_->motorVelocity(),
|
pl_status = pC_->getDoubleParam(axisNo_, pC_->motorVelocity(),
|
||||||
@ -516,7 +680,7 @@ asynStatus sinqAxis::startMovTimeoutWatchdog() {
|
|||||||
if (pl_status == asynSuccess) {
|
if (pl_status == asynSuccess) {
|
||||||
|
|
||||||
timeContSpeed = std::ceil(
|
timeContSpeed = std::ceil(
|
||||||
std::fabs(targetPosition_ - motorPosition) / motorVelocity);
|
std::fabs(targetPosition_ - motorPos) / motorVelocity);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -560,14 +724,22 @@ asynStatus sinqAxis::checkMovTimeoutWatchdog(bool moving) {
|
|||||||
return asynSuccess;
|
return asynSuccess;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Create the unique callsite identifier manually so it can be used later in
|
||||||
|
// the shouldBePrinted calls.
|
||||||
|
msgPrintControlKey key = msgPrintControlKey(pC_->portName, axisNo_,
|
||||||
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
|
|
||||||
// Check if the expected time of arrival has been exceeded.
|
// Check if the expected time of arrival has been exceeded.
|
||||||
if (expectedArrivalTime_ < time(NULL)) {
|
if (expectedArrivalTime_ < time(NULL)) {
|
||||||
// Check the watchdog
|
// Check the watchdog
|
||||||
asynPrint(pC_->asynUserSelf(), ASYN_TRACE_ERROR,
|
if (pC_->getMsgPrintControl().shouldBePrinted(key, true,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\nExceeded "
|
pC_->pasynUser())) {
|
||||||
"expected arrival time %ld (current time is %ld).\n",
|
asynPrint(pC_->pasynUser(), ASYN_TRACE_ERROR,
|
||||||
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
|
"Controller \"%s\", axis %d => %s, line %d:\nExceeded "
|
||||||
expectedArrivalTime_, time(NULL));
|
"expected arrival time %ld (current time is %ld).\n",
|
||||||
|
pC_->portName, axisNo_, __PRETTY_FUNCTION__, __LINE__,
|
||||||
|
expectedArrivalTime_, time(NULL));
|
||||||
|
}
|
||||||
|
|
||||||
pl_status = setStringParam(
|
pl_status = setStringParam(
|
||||||
pC_->motorMessageText(),
|
pC_->motorMessageText(),
|
||||||
@ -583,10 +755,11 @@ asynStatus sinqAxis::checkMovTimeoutWatchdog(bool moving) {
|
|||||||
pC_->paramLibAccessFailed(pl_status, "motorStatusProblem_", axisNo_,
|
pC_->paramLibAccessFailed(pl_status, "motorStatusProblem_", axisNo_,
|
||||||
__PRETTY_FUNCTION__, __LINE__);
|
__PRETTY_FUNCTION__, __LINE__);
|
||||||
}
|
}
|
||||||
|
} else {
|
||||||
// Even if the movement timed out, the rest of the poll should continue.
|
pC_->getMsgPrintControl().resetCount(key, pC_->pasynUser());
|
||||||
return asynSuccess;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// Even if the movement timed out, the rest of the poll should continue.
|
||||||
return asynSuccess;
|
return asynSuccess;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -605,8 +778,7 @@ extern "C" {
|
|||||||
*/
|
*/
|
||||||
asynStatus setWatchdogEnabled(const char *portName, int axisNo, int enable) {
|
asynStatus setWatchdogEnabled(const char *portName, int axisNo, int enable) {
|
||||||
|
|
||||||
sinqController *pC;
|
sinqController *pC = (sinqController *)findAsynPortDriver(portName);
|
||||||
pC = (sinqController *)findAsynPortDriver(portName);
|
|
||||||
if (pC == nullptr) {
|
if (pC == nullptr) {
|
||||||
errlogPrintf("Controller \"%s\" => %s, line %d:\nPort %s not found.",
|
errlogPrintf("Controller \"%s\" => %s, line %d:\nPort %s not found.",
|
||||||
portName, __PRETTY_FUNCTION__, __LINE__, portName);
|
portName, __PRETTY_FUNCTION__, __LINE__, portName);
|
||||||
@ -664,8 +836,7 @@ asynStatus setOffsetMovTimeout(const char *portName, int axisNo,
|
|||||||
sinqAxis *axis = dynamic_cast<sinqAxis *>(asynAxis);
|
sinqAxis *axis = dynamic_cast<sinqAxis *>(asynAxis);
|
||||||
if (axis == nullptr) {
|
if (axis == nullptr) {
|
||||||
errlogPrintf("Controller \"%s\" => %s, line %d:\nAxis %d does not "
|
errlogPrintf("Controller \"%s\" => %s, line %d:\nAxis %d does not "
|
||||||
"exist or is not an "
|
"exist or is not an instance of sinqAxis.",
|
||||||
"instance of sinqAxis.",
|
|
||||||
portName, __PRETTY_FUNCTION__, __LINE__, axisNo);
|
portName, __PRETTY_FUNCTION__, __LINE__, axisNo);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
103
src/sinqAxis.h
103
src/sinqAxis.h
@ -7,6 +7,7 @@ Stefan Mathis, November 2024
|
|||||||
#ifndef sinqAxis_H
|
#ifndef sinqAxis_H
|
||||||
#define sinqAxis_H
|
#define sinqAxis_H
|
||||||
#include "asynMotorAxis.h"
|
#include "asynMotorAxis.h"
|
||||||
|
#include <epicsTime.h>
|
||||||
|
|
||||||
class epicsShareClass sinqAxis : public asynMotorAxis {
|
class epicsShareClass sinqAxis : public asynMotorAxis {
|
||||||
public:
|
public:
|
||||||
@ -19,15 +20,12 @@ class epicsShareClass sinqAxis : public asynMotorAxis {
|
|||||||
sinqAxis(class sinqController *pC_, int axisNo);
|
sinqAxis(class sinqController *pC_, int axisNo);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Perform some standardized operation before and after the concrete
|
* @brief Perform some standardized operations before and after the concrete
|
||||||
`doPoll` implementation.
|
`doPoll` implementation.
|
||||||
*
|
*
|
||||||
* Wrapper around doPoll which performs the following operations:
|
* Wrapper around `doPoll` which performs the following operations:
|
||||||
Before calling doPoll:
|
|
||||||
|
|
||||||
- Try to execute atFirstPoll once (and retry, if that failed)
|
- Call the `doPoll` method
|
||||||
|
|
||||||
After calling doPoll:
|
|
||||||
|
|
||||||
- Reset motorStatusProblem_, motorStatusCommsError_ and motorMessageText_ if
|
- Reset motorStatusProblem_, motorStatusCommsError_ and motorMessageText_ if
|
||||||
doPoll returned asynSuccess
|
doPoll returned asynSuccess
|
||||||
@ -45,8 +43,8 @@ class epicsShareClass sinqAxis : public asynMotorAxis {
|
|||||||
*
|
*
|
||||||
* @param moving Forwarded to `doPoll`.
|
* @param moving Forwarded to `doPoll`.
|
||||||
* @return asynStatus Forward the status of `doPoll`, unless one of
|
* @return asynStatus Forward the status of `doPoll`, unless one of
|
||||||
the parameter library operation fails (in that case, returns the failed
|
the parameter library operation fails (in that case, returns the status of
|
||||||
operation status).
|
the failed operation.
|
||||||
*/
|
*/
|
||||||
asynStatus poll(bool *moving);
|
asynStatus poll(bool *moving);
|
||||||
|
|
||||||
@ -61,11 +59,12 @@ class epicsShareClass sinqAxis : public asynMotorAxis {
|
|||||||
virtual asynStatus doPoll(bool *moving);
|
virtual asynStatus doPoll(bool *moving);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Perform some standardized operation before and after the concrete
|
* @brief Perform some standardized operations before and after the concrete
|
||||||
`doMove` implementation.
|
`doMove` implementation.
|
||||||
|
|
||||||
* Wrapper around `doMove` which calculates the (absolute) target position
|
* Wrapper around `doMove` which calculates the (absolute) target position
|
||||||
and stores it in the parameter library. After that, it calls and returns
|
and stores it in the member variable `targetPosition_`. This member variable
|
||||||
|
is e.g. used for the movement watchdog. Afterwards, it calls and returns
|
||||||
`doMove`.
|
`doMove`.
|
||||||
*
|
*
|
||||||
* @param position Forwarded to `doMove`.
|
* @param position Forwarded to `doMove`.
|
||||||
@ -162,20 +161,30 @@ class epicsShareClass sinqAxis : public asynMotorAxis {
|
|||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief This function is called when the PV "$(INSTR)$(M):Reset" is set to
|
* @brief This function is called when the PV "$(INSTR)$(M):Reset" is set to
|
||||||
* any value. This method should be implemented by a child class of
|
* any value. It calls `doReset` (which ought to be implemented by a child
|
||||||
* sinqAxis.
|
* class) and then performs da defined number of consecutive fast polls. If
|
||||||
|
* one of the polls returns asynSuccess, it returns immediately.
|
||||||
*
|
*
|
||||||
* @return asynStatus
|
* @return asynStatus
|
||||||
*/
|
*/
|
||||||
virtual asynStatus reset();
|
asynStatus reset();
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Implementation of the "proper", device-specific `reset` method.
|
||||||
|
This method should be implemented by a child class of sinqAxis. If the
|
||||||
|
motor cannot be reset, this function should return asynError.
|
||||||
|
*
|
||||||
|
* @return asynStatus
|
||||||
|
*/
|
||||||
|
virtual asynStatus doReset();
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief This function enables / disables an axis. It should be implemented
|
* @brief This function enables / disables an axis. It should be implemented
|
||||||
* by a child class of sinqAxis.
|
* by a child class of sinqAxis.
|
||||||
*
|
*
|
||||||
* The concrete implementation should (but doesn't need to) follow the
|
* The concrete implementation should (but doesn't need to) follow the
|
||||||
* convetion that a value of 0 disables the axis and any other value enables
|
* convention that a value of 0 disables the axis and any other value
|
||||||
* it.
|
* enables it.
|
||||||
*
|
*
|
||||||
* @param on
|
* @param on
|
||||||
* @return asynStatus
|
* @return asynStatus
|
||||||
@ -188,7 +197,7 @@ class epicsShareClass sinqAxis : public asynMotorAxis {
|
|||||||
* Populates the speed fields of the motor record. If the param lib
|
* Populates the speed fields of the motor record. If the param lib
|
||||||
* entry motorCanSetSpeed_ (connected to the PV x:VariableSpeed) is set to
|
* entry motorCanSetSpeed_ (connected to the PV x:VariableSpeed) is set to
|
||||||
* 1, VBAS and VMAX are set to min and max respectively. Otherwise, they are
|
* 1, VBAS and VMAX are set to min and max respectively. Otherwise, they are
|
||||||
* set to val. Additionally, the speed itself is set to velo.
|
* set to val. Additionally, the speed itself is set to VELO.
|
||||||
*
|
*
|
||||||
* The units of the inputs are engineering units (EGU) per second (e.g. mm/s
|
* The units of the inputs are engineering units (EGU) per second (e.g. mm/s
|
||||||
* if the EGU is mm).
|
* if the EGU is mm).
|
||||||
@ -243,15 +252,15 @@ class epicsShareClass sinqAxis : public asynMotorAxis {
|
|||||||
|
|
||||||
with
|
with
|
||||||
|
|
||||||
timeContSpeed = abs(motorTargetPosition - motorPosition) / motorVelBase
|
timeContSpeed = abs(targetPosition - motorPosition) / motorVelBase
|
||||||
timeAcc = motorVelBase / motorAccel
|
timeAcc = motorVelBase / motorAccel
|
||||||
|
|
||||||
The values motorTargetPosition, motorVelBase, motorAccel and
|
The values motorVelBase, motorAccel and positionAtMovementStart are taken
|
||||||
positionAtMovementStart are taken from the parameter library. Therefore it
|
from the parameter library. Therefore it is necessary to populate them
|
||||||
is necessary to populate them before using this function. If they are not
|
before using this function. If they are not given, both speed and velocity
|
||||||
given, both speed and velocity are assumed to be infinite. This means that
|
are assumed to be infinite. This means that timeContSpeed and/or timeAcc are
|
||||||
timeContSpeed and/or timeAcc are set to zero. motorTargetPosition is
|
set to zero. targetPosition is populated automatically when using the doMove
|
||||||
populated automatically when using the doMove function.
|
function.
|
||||||
|
|
||||||
The values offsetMovTimeout_ and scaleMovTimeout_ can be set directly from
|
The values offsetMovTimeout_ and scaleMovTimeout_ can be set directly from
|
||||||
the IOC shell with the functions setScaleMovTimeout and setOffsetMovTimeout,
|
the IOC shell with the functions setScaleMovTimeout and setOffsetMovTimeout,
|
||||||
@ -280,7 +289,7 @@ class epicsShareClass sinqAxis : public asynMotorAxis {
|
|||||||
* @brief Set the offsetMovTimeout. Also available in the IOC shell
|
* @brief Set the offsetMovTimeout. Also available in the IOC shell
|
||||||
* (see "extern C" section in sinqController.cpp).
|
* (see "extern C" section in sinqController.cpp).
|
||||||
*
|
*
|
||||||
See documentation of `checkMovTimeoutWatchdog` for details.
|
* See documentation of `checkMovTimeoutWatchdog` for details.
|
||||||
*
|
*
|
||||||
* @param offsetMovTimeout Offset (in seconds)
|
* @param offsetMovTimeout Offset (in seconds)
|
||||||
* @return asynStatus
|
* @return asynStatus
|
||||||
@ -311,15 +320,61 @@ class epicsShareClass sinqAxis : public asynMotorAxis {
|
|||||||
*/
|
*/
|
||||||
int axisNo() { return axisNo_; }
|
int axisNo() { return axisNo_; }
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Read the motor position from the paramLib, adjusted for the
|
||||||
|
* motorRecResolution
|
||||||
|
*
|
||||||
|
* The motorPosition value in the paramLib is the encoder position
|
||||||
|
* divided by the motorRecResolution (see README.md). This function
|
||||||
|
* fetches the paramLib value and multiplies it with motorRecResolution
|
||||||
|
* (also fetched from the paramLib).
|
||||||
|
*
|
||||||
|
* @param motorPositon
|
||||||
|
* @return asynStatus
|
||||||
|
*/
|
||||||
|
asynStatus motorPosition(double *motorPositon);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Write the motor position in the paramLib, adjusted for the
|
||||||
|
* motorRecResolution
|
||||||
|
*
|
||||||
|
* The motorPosition value in the paramLib is the encoder position
|
||||||
|
* divided by the motorRecResolution (see README.md). This function takes
|
||||||
|
* the input value and divides it with motorRecResolution (fetched from
|
||||||
|
* the paramLib).
|
||||||
|
*
|
||||||
|
* @param motorPosition
|
||||||
|
* @return asynStatus
|
||||||
|
*/
|
||||||
|
asynStatus setMotorPosition(double motorPosition);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Check if the axis is not connected and print a corresponding error
|
||||||
|
* message
|
||||||
|
*
|
||||||
|
* This method is meant to be used at the end of "interactive" function
|
||||||
|
* calls such as move, home, stop etc which can be manually triggered from
|
||||||
|
* the IOC shell or from the channel access protocol.
|
||||||
|
*/
|
||||||
|
asynStatus assertConnected();
|
||||||
|
|
||||||
protected:
|
protected:
|
||||||
// Internal variables used in the movement timeout watchdog
|
// Internal variables used in the movement timeout watchdog
|
||||||
time_t expectedArrivalTime_;
|
time_t expectedArrivalTime_;
|
||||||
time_t offsetMovTimeout_;
|
time_t offsetMovTimeout_;
|
||||||
|
|
||||||
double scaleMovTimeout_;
|
double scaleMovTimeout_;
|
||||||
bool watchdogMovActive_;
|
bool watchdogMovActive_;
|
||||||
// Store the motor target position for the movement time calculation
|
// Store the motor target position for the movement time calculation
|
||||||
double targetPosition_;
|
double targetPosition_;
|
||||||
|
|
||||||
|
bool wasMoving_;
|
||||||
|
|
||||||
|
/*
|
||||||
|
Store the time since the last poll
|
||||||
|
*/
|
||||||
|
epicsTimeStamp lastPollTime_;
|
||||||
|
|
||||||
private:
|
private:
|
||||||
sinqController *pC_;
|
sinqController *pC_;
|
||||||
};
|
};
|
||||||
|
@ -48,15 +48,22 @@ sinqController::sinqController(const char *portName,
|
|||||||
ASYN_CANBLOCK | ASYN_MULTIDEVICE,
|
ASYN_CANBLOCK | ASYN_MULTIDEVICE,
|
||||||
1, // autoconnect
|
1, // autoconnect
|
||||||
0, 0), // Default priority and stack size
|
0, 0), // Default priority and stack size
|
||||||
msgPrintControl_(4) {
|
msgPrintControl_() {
|
||||||
|
|
||||||
asynStatus status = asynSuccess;
|
asynStatus status = asynSuccess;
|
||||||
ipPortUser_ = nullptr;
|
|
||||||
|
// Handle to the asynUser of the IP port asyn driver
|
||||||
|
pasynOctetSyncIOipPort_ = nullptr;
|
||||||
|
|
||||||
// Initial values for the average timeout mechanism, can be overwritten
|
// Initial values for the average timeout mechanism, can be overwritten
|
||||||
// later by a FFI function
|
// later by a FFI function
|
||||||
comTimeoutWindow_ = 3600;
|
comTimeoutWindow_ = 3600; // seconds
|
||||||
|
|
||||||
|
// Number of timeouts which may occur before an error is forwarded to the
|
||||||
|
// user
|
||||||
maxNumberTimeouts_ = 60;
|
maxNumberTimeouts_ = 60;
|
||||||
|
|
||||||
|
// Queue holding the timeout event timestamps
|
||||||
timeoutEvents_ = {};
|
timeoutEvents_ = {};
|
||||||
|
|
||||||
// Inform the user after 10 timeouts in a row (default value)
|
// Inform the user after 10 timeouts in a row (default value)
|
||||||
@ -74,8 +81,9 @@ sinqController::sinqController(const char *portName,
|
|||||||
We try to connect to the port via the port name provided by the constructor.
|
We try to connect to the port via the port name provided by the constructor.
|
||||||
If this fails, the function is terminated via exit.
|
If this fails, the function is terminated via exit.
|
||||||
*/
|
*/
|
||||||
pasynOctetSyncIO->connect(ipPortConfigName, 0, &ipPortUser_, NULL);
|
pasynOctetSyncIO->connect(ipPortConfigName, 0, &pasynOctetSyncIOipPort_,
|
||||||
if (status != asynSuccess || ipPortUser_ == nullptr) {
|
NULL);
|
||||||
|
if (status != asynSuccess || pasynOctetSyncIOipPort_ == nullptr) {
|
||||||
errlogPrintf("Controller \"%s\" => %s, line %d:\nFATAL ERROR (cannot "
|
errlogPrintf("Controller \"%s\" => %s, line %d:\nFATAL ERROR (cannot "
|
||||||
"connect to MCU controller).\n"
|
"connect to MCU controller).\n"
|
||||||
"Terminating IOC",
|
"Terminating IOC",
|
||||||
@ -162,6 +170,16 @@ sinqController::sinqController(const char *portName,
|
|||||||
exit(-1);
|
exit(-1);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
status = createParam("MOTOR_CONNECTED", asynParamInt32, &motorConnected_);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR,
|
||||||
|
"Controller \"%s\" => %s, line %d:\nFATAL ERROR (creating a "
|
||||||
|
"parameter failed with %s).\nTerminating IOC",
|
||||||
|
portName, __PRETTY_FUNCTION__, __LINE__,
|
||||||
|
stringifyAsynStatus(status));
|
||||||
|
exit(-1);
|
||||||
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
We need to introduce 2 new parameters in order to write the limits from the
|
We need to introduce 2 new parameters in order to write the limits from the
|
||||||
driver to the EPICS record. See the comment in sinqController.h next to
|
driver to the EPICS record. See the comment in sinqController.h next to
|
||||||
@ -244,6 +262,16 @@ sinqController::sinqController(const char *portName,
|
|||||||
exit(-1);
|
exit(-1);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
status = createParam("ADAPTIVE_POLLING", asynParamInt32, &adaptivePolling_);
|
||||||
|
if (status != asynSuccess) {
|
||||||
|
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR,
|
||||||
|
"Controller \"%s\" => %s, line %d:\nFATAL ERROR (creating a "
|
||||||
|
"parameter failed with %s).\nTerminating IOC",
|
||||||
|
portName, __PRETTY_FUNCTION__, __LINE__,
|
||||||
|
stringifyAsynStatus(status));
|
||||||
|
exit(-1);
|
||||||
|
}
|
||||||
|
|
||||||
status = createParam("ENCODER_TYPE", asynParamOctet, &encoderType_);
|
status = createParam("ENCODER_TYPE", asynParamOctet, &encoderType_);
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR,
|
asynPrint(this->pasynUserSelf, ASYN_TRACE_ERROR,
|
||||||
@ -341,14 +369,14 @@ asynStatus sinqController::readInt32(asynUser *pasynUser, epicsInt32 *value) {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
asynStatus sinqController::errMsgCouldNotParseResponse(const char *command,
|
asynStatus sinqController::couldNotParseResponse(const char *command,
|
||||||
const char *response,
|
const char *response,
|
||||||
int axisNo,
|
int axisNo,
|
||||||
const char *functionName,
|
const char *functionName,
|
||||||
int line) {
|
int line) {
|
||||||
asynStatus pl_status = asynSuccess;
|
asynStatus pl_status = asynSuccess;
|
||||||
|
|
||||||
asynPrint(ipPortUser_, ASYN_TRACE_ERROR,
|
asynPrint(pasynOctetSyncIOipPort_, ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\nCould not interpret "
|
"Controller \"%s\", axis %d => %s, line %d:\nCould not interpret "
|
||||||
"response \"%s\" for command \"%s\".\n",
|
"response \"%s\" for command \"%s\".\n",
|
||||||
portName, axisNo, functionName, line, response, command);
|
portName, axisNo, functionName, line, response, command);
|
||||||
@ -377,7 +405,7 @@ asynStatus sinqController::paramLibAccessFailed(asynStatus status,
|
|||||||
int line) {
|
int line) {
|
||||||
|
|
||||||
if (status != asynSuccess) {
|
if (status != asynSuccess) {
|
||||||
asynPrint(ipPortUser_, ASYN_TRACE_ERROR,
|
asynPrint(pasynOctetSyncIOipPort_, ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\n Accessing the "
|
"Controller \"%s\", axis %d => %s, line %d:\n Accessing the "
|
||||||
"parameter library failed for parameter %s with error %s.\n",
|
"parameter library failed for parameter %s with error %s.\n",
|
||||||
portName, axisNo, functionName, line, parameter,
|
portName, axisNo, functionName, line, parameter,
|
||||||
@ -477,8 +505,8 @@ asynStatus sinqController::checkMaxSubsequentTimeouts(int timeoutNo, int axisNo,
|
|||||||
asynPrint(
|
asynPrint(
|
||||||
this->pasynUserSelf, ASYN_TRACE_ERROR,
|
this->pasynUserSelf, ASYN_TRACE_ERROR,
|
||||||
"Controller \"%s\", axis %d => %s, line %d:\nMore than %d "
|
"Controller \"%s\", axis %d => %s, line %d:\nMore than %d "
|
||||||
"subsequent communication "
|
"subsequent communication timeouts. Check whether the "
|
||||||
"timeouts\n",
|
"controller is still running and connected to the network.\n",
|
||||||
this->portName, axisNo, __PRETTY_FUNCTION__, __LINE__,
|
this->portName, axisNo, __PRETTY_FUNCTION__, __LINE__,
|
||||||
maxSubsequentTimeouts_);
|
maxSubsequentTimeouts_);
|
||||||
|
|
||||||
@ -504,7 +532,7 @@ asynStatus sinqController::checkMaxSubsequentTimeouts(int timeoutNo,
|
|||||||
|
|
||||||
char motorMessage[200] = {0};
|
char motorMessage[200] = {0};
|
||||||
|
|
||||||
asynStatus status = checkMaxSubsequentTimeouts(axis->axisNo(), timeoutNo,
|
asynStatus status = checkMaxSubsequentTimeouts(timeoutNo, axis->axisNo(),
|
||||||
motorMessage, 200);
|
motorMessage, 200);
|
||||||
if (status == asynError) {
|
if (status == asynError) {
|
||||||
status = axis->setStringParam(motorMessageText_, motorMessage);
|
status = axis->setStringParam(motorMessageText_, motorMessage);
|
||||||
@ -591,8 +619,8 @@ extern "C" {
|
|||||||
* implementation)
|
* implementation)
|
||||||
*
|
*
|
||||||
* @param comTimeoutWindow Size of the time window used to calculate
|
* @param comTimeoutWindow Size of the time window used to calculate
|
||||||
* the moving average of timeout events. Set this value to 0 to deactivate
|
* the moving average of timeout events in seconds. Set this value to 0 to
|
||||||
* the watchdog.
|
* deactivate the watchdog.
|
||||||
* @param maxNumberTimeouts Maximum number of timeouts which may occur
|
* @param maxNumberTimeouts Maximum number of timeouts which may occur
|
||||||
* within the time window before the watchdog is triggered.
|
* within the time window before the watchdog is triggered.
|
||||||
* @return asynStatus
|
* @return asynStatus
|
||||||
@ -646,9 +674,9 @@ asynStatus setMaxSubsequentTimeouts(const char *portName,
|
|||||||
if (ptr == nullptr) {
|
if (ptr == nullptr) {
|
||||||
/*
|
/*
|
||||||
We can't use asynPrint here since this macro would require us
|
We can't use asynPrint here since this macro would require us
|
||||||
to get a ipPortUser_ from a pointer to an asynPortDriver.
|
to get a pasynOctetSyncIOipPort_ from a pointer to an asynPortDriver.
|
||||||
However, the given pointer is a nullptr and therefore doesn't
|
However, the given pointer is a nullptr and therefore doesn't
|
||||||
have a ipPortUser_! printf is an EPICS alternative which
|
have a pasynOctetSyncIOipPort_! printf is an EPICS alternative which
|
||||||
works w/o that, but doesn't offer the comfort provided
|
works w/o that, but doesn't offer the comfort provided
|
||||||
by the asynTrace-facility
|
by the asynTrace-facility
|
||||||
*/
|
*/
|
||||||
|
@ -32,17 +32,17 @@ class epicsShareClass sinqController : public asynMotorController {
|
|||||||
pAxes_ which has the length specified here. When getting an axis, the
|
pAxes_ which has the length specified here. When getting an axis, the
|
||||||
`getAxis` function indexes into this array. A length of 8 would therefore
|
`getAxis` function indexes into this array. A length of 8 would therefore
|
||||||
mean that the axis slots 0 to 7 are available. However, in order to keep the
|
mean that the axis slots 0 to 7 are available. However, in order to keep the
|
||||||
axis enumeration in sync with the electronics counting logic, we start
|
axis enumeration identical to that of the hardware, we start counting the
|
||||||
counting the axes with 1 and end at 8. Therefore, an offset of 1 is added
|
axes with 1 and end at 8. Therefore, an offset of 1 is added when forwarding
|
||||||
when forwarding this number to asynMotorController.
|
this number to asynMotorController.
|
||||||
* @param movingPollPeriod Time between polls when moving (in seconds)
|
* @param movingPollPeriod Time between polls when moving (in seconds)
|
||||||
* @param idlePollPeriod Time between polls when not moving (in
|
* @param idlePollPeriod Time between polls when not moving (in
|
||||||
seconds)
|
seconds)
|
||||||
* @param extraParams Number of extra parameter library entries
|
* @param extraParams Number of extra parameter library entries
|
||||||
* created in a concrete driver implementation
|
* created in a concrete driver implementation
|
||||||
*/
|
*/
|
||||||
sinqController(const char *portName, const char *SINQPortName, int numAxes,
|
sinqController(const char *portName, const char *ipPortConfigName,
|
||||||
double movingPollPeriod, double idlePollPeriod,
|
int numAxes, double movingPollPeriod, double idlePollPeriod,
|
||||||
int numExtraParams);
|
int numExtraParams);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
@ -82,7 +82,7 @@ class epicsShareClass sinqController : public asynMotorController {
|
|||||||
*
|
*
|
||||||
* If accessing the parameter library failed (return status !=
|
* If accessing the parameter library failed (return status !=
|
||||||
asynSuccess), calling this function writes a standardized message to both
|
asynSuccess), calling this function writes a standardized message to both
|
||||||
the IOC shell and the motor message text PV. It then returns the input
|
the IOC shell and the motorMessageText PV. It then returns the input
|
||||||
status.
|
status.
|
||||||
*
|
*
|
||||||
* @param status Status of the failed parameter library access
|
* @param status Status of the failed parameter library access
|
||||||
@ -90,7 +90,7 @@ class epicsShareClass sinqController : public asynMotorController {
|
|||||||
error messages.
|
error messages.
|
||||||
* @param functionName Name of the caller function. It is recommended
|
* @param functionName Name of the caller function. It is recommended
|
||||||
to use a macro, e.g. __func__ or __PRETTY_FUNCTION__.
|
to use a macro, e.g. __func__ or __PRETTY_FUNCTION__.
|
||||||
* @param line Source code line where this function is
|
* @param line Source code line where this function is
|
||||||
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 input status.
|
* @return asynStatus Returns input status.
|
||||||
*/
|
*/
|
||||||
@ -115,9 +115,9 @@ class epicsShareClass sinqController : public asynMotorController {
|
|||||||
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 line);
|
int line);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Convert an asynStatus into a descriptive string.
|
* @brief Convert an asynStatus into a descriptive string.
|
||||||
@ -131,7 +131,7 @@ class epicsShareClass sinqController : public asynMotorController {
|
|||||||
* @brief This function should be called when a communication timeout
|
* @brief This function should be called when a communication timeout
|
||||||
occured. It calculates the frequency of communication timeout events and
|
occured. It calculates the frequency of communication timeout events and
|
||||||
creates an error message, if an threshold has been exceeded.
|
creates an error message, if an threshold has been exceeded.
|
||||||
*
|
|
||||||
Occasionally, communication timeouts between the IOC and the motor
|
Occasionally, communication timeouts between the IOC and the motor
|
||||||
controller may happen, usually because the controller takes too long to
|
controller may happen, usually because the controller takes too long to
|
||||||
respond. If this happens infrequently, this is not a problem. However, if it
|
respond. If this happens infrequently, this is not a problem. However, if it
|
||||||
@ -181,7 +181,7 @@ class epicsShareClass sinqController : public asynMotorController {
|
|||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Inform the user, if the number of timeouts exceeds the threshold
|
* @brief Inform the user, if the number of timeouts exceeds the threshold
|
||||||
* specified with setMaxSubsequentTimeouts
|
* specified with `setMaxSubsequentTimeouts`.
|
||||||
*
|
*
|
||||||
* @param timeoutNo Number of subsequent timeouts which already
|
* @param timeoutNo Number of subsequent timeouts which already
|
||||||
* happened.
|
* happened.
|
||||||
@ -192,10 +192,10 @@ class epicsShareClass sinqController : public asynMotorController {
|
|||||||
class sinqAxis *axis);
|
class sinqAxis *axis);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief See documentation of checkMaxSubsequentTimeouts(sinqAxis * axis)
|
* @brief See documentation of `checkMaxSubsequentTimeouts(sinqAxis * axis)`
|
||||||
*
|
*
|
||||||
* @param userMessage Buffer for the user message
|
* @param userMessage Buffer for the user message
|
||||||
* @param userMessageSize Buffer size in chars
|
* @param userMessageSize Buffer size in chars
|
||||||
* @return asynStatus
|
* @return asynStatus
|
||||||
*/
|
*/
|
||||||
virtual asynStatus checkMaxSubsequentTimeouts(int timeoutNo, int axisNo,
|
virtual asynStatus checkMaxSubsequentTimeouts(int timeoutNo, int axisNo,
|
||||||
@ -216,8 +216,8 @@ class epicsShareClass sinqController : public asynMotorController {
|
|||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Get a reference to the map used to control the maximum number of
|
* @brief Get a reference to the map used to control the maximum number of
|
||||||
* message repetitions. See the documentation of printRepetitionWatchdog in
|
* message repetitions. See the documentation of `printRepetitionWatchdog`
|
||||||
* msgPrintControl.h for details.
|
* in msgPrintControl.h for details.
|
||||||
*/
|
*/
|
||||||
msgPrintControl &getMsgPrintControl();
|
msgPrintControl &getMsgPrintControl();
|
||||||
|
|
||||||
@ -253,7 +253,7 @@ class epicsShareClass sinqController : public asynMotorController {
|
|||||||
int motorStatus() { return motorStatus_; }
|
int motorStatus() { return motorStatus_; }
|
||||||
int motorUpdateStatus() { return motorUpdateStatus_; }
|
int motorUpdateStatus() { return motorUpdateStatus_; }
|
||||||
|
|
||||||
// Accessors for sztatus bits (integers)
|
// Accessors for status bits (integers)
|
||||||
int motorStatusDirection() { return motorStatusDirection_; }
|
int motorStatusDirection() { return motorStatusDirection_; }
|
||||||
int motorStatusDone() { return motorStatusDone_; }
|
int motorStatusDone() { return motorStatusDone_; }
|
||||||
int motorStatusHighLimit() { return motorStatusHighLimit_; }
|
int motorStatusHighLimit() { return motorStatusHighLimit_; }
|
||||||
@ -285,25 +285,41 @@ class epicsShareClass sinqController : public asynMotorController {
|
|||||||
int motorCanSetSpeed() { return motorCanSetSpeed_; }
|
int motorCanSetSpeed() { return motorCanSetSpeed_; }
|
||||||
int motorLimitsOffset() { return motorLimitsOffset_; }
|
int motorLimitsOffset() { return motorLimitsOffset_; }
|
||||||
int motorForceStop() { return motorForceStop_; }
|
int motorForceStop() { return motorForceStop_; }
|
||||||
|
int motorConnected() { return motorConnected_; }
|
||||||
int motorVeloFromDriver() { return motorVeloFromDriver_; }
|
int motorVeloFromDriver() { return motorVeloFromDriver_; }
|
||||||
int motorVbasFromDriver() { return motorVbasFromDriver_; }
|
int motorVbasFromDriver() { return motorVbasFromDriver_; }
|
||||||
int motorVmaxFromDriver() { return motorVmaxFromDriver_; }
|
int motorVmaxFromDriver() { return motorVmaxFromDriver_; }
|
||||||
int motorAcclFromDriver() { return motorAcclFromDriver_; }
|
int motorAcclFromDriver() { return motorAcclFromDriver_; }
|
||||||
int motorHighLimitFromDriver() { return motorHighLimitFromDriver_; }
|
int motorHighLimitFromDriver() { return motorHighLimitFromDriver_; }
|
||||||
int motorLowLimitFromDriver() { return motorLowLimitFromDriver_; }
|
int motorLowLimitFromDriver() { return motorLowLimitFromDriver_; }
|
||||||
|
int adaptivePolling() { return adaptivePolling_; }
|
||||||
int encoderType() { return encoderType_; }
|
int encoderType() { return encoderType_; }
|
||||||
|
|
||||||
// Additional members
|
// Additional members
|
||||||
int numAxes() { return numAxes_; }
|
int numAxes() { return numAxes_; }
|
||||||
asynUser *asynUserSelf() { return pasynUserSelf; }
|
double idlePollPeriod() { return idlePollPeriod_; }
|
||||||
asynUser *ipPortUser() { return ipPortUser_; }
|
double movingPollPeriod() { return movingPollPeriod_; }
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Return a pointer to the asynUser of the controller
|
||||||
|
*
|
||||||
|
* @return asynUser*
|
||||||
|
*/
|
||||||
|
asynUser *pasynUser() { return pasynUserSelf; }
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Return a pointer to the low-level octet (string) IP Port
|
||||||
|
*
|
||||||
|
* @return asynUser*
|
||||||
|
*/
|
||||||
|
asynUser *pasynOctetSyncIOipPort() { return pasynOctetSyncIOipPort_; }
|
||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
|
|
||||||
protected:
|
protected:
|
||||||
// Pointer to the port user which is specified by the char array
|
// Pointer to the port user which is specified by the char array
|
||||||
// ipPortConfigName in the constructor
|
// `ipPortConfigName` in the constructor
|
||||||
asynUser *ipPortUser_;
|
asynUser *pasynOctetSyncIOipPort_;
|
||||||
double movingPollPeriod_;
|
double movingPollPeriod_;
|
||||||
double idlePollPeriod_;
|
double idlePollPeriod_;
|
||||||
msgPrintControl msgPrintControl_;
|
msgPrintControl msgPrintControl_;
|
||||||
@ -320,6 +336,9 @@ class epicsShareClass sinqController : public asynMotorController {
|
|||||||
int maxSubsequentTimeouts_;
|
int maxSubsequentTimeouts_;
|
||||||
bool maxSubsequentTimeoutsExceeded_;
|
bool maxSubsequentTimeoutsExceeded_;
|
||||||
|
|
||||||
|
/*
|
||||||
|
See the documentation in db/sinqMotor.db for the following integers
|
||||||
|
*/
|
||||||
#define FIRST_SINQMOTOR_PARAM motorMessageText_
|
#define FIRST_SINQMOTOR_PARAM motorMessageText_
|
||||||
int motorMessageText_;
|
int motorMessageText_;
|
||||||
int motorReset_;
|
int motorReset_;
|
||||||
@ -330,6 +349,7 @@ class epicsShareClass sinqController : public asynMotorController {
|
|||||||
int motorCanSetSpeed_;
|
int motorCanSetSpeed_;
|
||||||
int motorLimitsOffset_;
|
int motorLimitsOffset_;
|
||||||
int motorForceStop_;
|
int motorForceStop_;
|
||||||
|
int motorConnected_;
|
||||||
/*
|
/*
|
||||||
These parameters are here to write values from the hardware to the EPICS
|
These parameters are here to write values from the hardware to the EPICS
|
||||||
motor record. Using motorHighLimit_ / motorLowLimit_ does not work:
|
motor record. Using motorHighLimit_ / motorLowLimit_ does not work:
|
||||||
@ -343,6 +363,7 @@ class epicsShareClass sinqController : public asynMotorController {
|
|||||||
int motorAcclFromDriver_;
|
int motorAcclFromDriver_;
|
||||||
int motorHighLimitFromDriver_;
|
int motorHighLimitFromDriver_;
|
||||||
int motorLowLimitFromDriver_;
|
int motorLowLimitFromDriver_;
|
||||||
|
int adaptivePolling_;
|
||||||
int encoderType_;
|
int encoderType_;
|
||||||
#define LAST_SINQMOTOR_PARAM encoderType_
|
#define LAST_SINQMOTOR_PARAM encoderType_
|
||||||
|
|
||||||
|
Reference in New Issue
Block a user