ID | Label | Type | #Val | Min | Max | Attr | Description |
---|---|---|---|---|---|---|---|
10320 |
Enable clearing of integrator state flag |
Uint32 |
|
|
|
|
Enable clearing of the integrator torque in the PID compensator when the high power enable sequence is invoked. Default value is "1", which clears the integrator torque. If this flag is "0" then the integrator torque, which was derived previously, will be reinstated after high power is up. The main purpose mode 0 is to avoid excessive arm "droop" if the axes are heavily loaded due to gravity and/or payload. So, this parameter is typically set to 0 for Z-axes that are subject to gravity loading. |
10321 |
Feedforward type selection |
Uint32 |
|
|
|
|
Feedforward compensation type selection. The feedforward torque is added with the PID compensator torque to compose the final output torque command into the amplifier. Following are the available selections: |
10322 |
Velocity error type selection |
Uint32 |
|
|
|
|
Type of velocity error utilized by the feedback compensator. There
are two selections for velocity error generation: |
10323 |
Position in-tolerance limit, mcnt |
Flt32 |
|
|
|
RO |
|
10324 |
Position in-tolerance duration, sec |
Flt32 |
|
|
|
|
|
10325 |
Position in-tolerance prediction window, sec |
Flt32 |
|
|
|
|
|
10326 |
Velocity error SPR filter pole, Hz |
Flt32 |
|
|
|
|
The single-pole rolloff (SPR) low-pass filter for the velocity tracking
error. The purpose of this filter is to filter out the noise introduced
due to limited encoder feedback resolution. In consideration of the
loop bandwidth, this filter pole value must be well above the velocity
loop bandwidth. The system default value is 100 Hz. |
10327 |
Accel error DPR filter pole, Hz |
Flt32 |
|
|
|
|
Double-pole rolloff (DPR) low-pass filter for the acceleration
error. The acceleration error is generated by backward-differencing
the velocity error, so, the result is very noisy. But if the encoder
has high resolution and if the acceleration error is heavily filtered
via this parameter, the cleaned-up signal may be used for resonance
cancellation. |
10328 |
Feedforward SPR filter pole, Hz |
Flt32 |
|
|
|
|
Single-pole rolloff (SPR) low-pass filter for the feedforward
torque. The main purpose of this parameter is to "soften" the edges
produced by the feedforward calculation. The system default value is
set at 0 Hz. |
10329 |
Torque output filter pole, Hz |
Flt32 |
|
|
|
|
An effective technique for eliminating oscillations in an axis is to filter out frequencies in the PID feedback output torque that can excite and/or reinforce the oscillation. The "Torque output filter pole and damping ratio" is the first of four sets of filters that can be configured as notch filters to suppress a range of frequencies in the PID loop output. Typically, these four sets of filters are utilized to suppress oscillations that range from 50hz to 500hz. For these types of oscillations, a filter pole frequency should be set somewhat lower than the frequency of the oscillation and the damping ratio should typically be sent to 0.3 or 0.4 (larger damping ratios increase the range of frequencies that are filtered out but reduces the strength of the filter). For situations where widely separate oscillation frequencies exist, a second, third and fourth notch filter, which operate in a cascaded series with the primary filter, can be employed (DataIDs 10353/10354, 10361/10362, 10365/10366). For each filter set, its parameters control a unity gain 2nd order filter for the PID output torque. This filter may be configured as follows: - A notch filter: by setting a valid filter pole and a non-zero damping ratio - A DPR filter: by setting a valid filter pole and setting the damping ratio to 0 In some cases, in order to effectively eliminate an oscillation, a notch filter should be used in combination with the "Accel error gain" (DataID 10338). Setting the filter pole to 0 disables the filter. Beware that by setting the damping ratio to 0 but leaving the filter pole as a valid number, will simply configure this as a DPR filter. |
10330 |
Torque output filter damping ratio |
Flt32 |
|
0.1 |
1 |
|
|
10331 |
Proportional gain, Kp |
Flt32 |
|
|
|
|
The servo feedback algorithms represent motor positions in units of
motor counts, which are typically the same as encoder counts, and generate
output commands in units of torque counts. Torque counts
range from +/- 32768 and are mapped to the full range of the amplifier
as defined by the "Amplifier PEAK(non-RMS) current, A(z-p)" (DataID 10610).
The standard unit of time for the servos is milliseconds. |
10332 |
Integral gain, Ki |
Flt32 |
|
|
|
|
|
10333 |
Derivative gain, Kd |
Flt32 |
|
|
|
|
|
10334 |
Integrator limit |
Flt32 |
|
|
|
|
Integrator torque limit in units of torque counts, tcnt's. Set to 2000 by default. |
10335 |
Integrator rate limit |
Flt32 |
|
|
|
|
This parameter restricts how quickly the integral torque can change by limiting the magnitude of the position error that is multiplied times the "Integral gain" (DataID 10332). This limit prevents the integrator from charging up too fast, which typically happens when there is an excessive tracking error (possibly due to a heavy payload and/or high acceleration). This provides a nonlinear effect, which dynamically lowers the compensator "zero" and helps stabilize the feedback loop. For example, if the "Position tracking error" (DataID 12320) is 400 encoder counts, and the rate limit is set to 100, the Integral gain will be multiplied by 100 (rather than 400) when the new integral torque value is computed. This value defaults to 50. |
10336 |
Acceleration feedforward gain |
Flt32 |
|
|
|
|
Feedforward gains, which are multiplied with the commanded acceleration
and velocity, respectively. The resulting torques are then added to
the feedback loop output torque to generate the final torque command
into the amplifier. |
10337 |
Velocity feedforward gain |
Flt32 |
|
|
|
|
|
10338 |
Accel error gain, Ka |
Flt32 |
|
|
|
|
This gain is multiplied times the filtered accel error (see DataID
10327) to generate a resonance cancellation torque and is in units
of tcnts/(mcnts/msec^2). In the case of an axis resonance problem,
it can be used under the following conditions: |
10339 |
Split axis cross-coupling gain |
Flt32 |
|
|
|
|
(Split-axis) This is a special feedback term that is only valid for motors that are controlled in split-axis mode. This gain factor is multiplied by the difference in the actual position of the two split-axis motors and the result is added into the PID loop. This correction assists in minimizing the tracking error between the two motors. This value defaults to 0. |
10340 |
Integrator deadband, mcnt |
Flt32 |
|
|
|
|
Defines a deadband region about the final target position
of the commanded motion. If the axis is
within the deadband region, the integrator value is frozen and not
altered until the axis is outside of the deadband or a new motion is
initiated. |
10341 |
Cross-coupling error SPR filter pole, Hz |
Flt32 |
|
|
|
|
(Split-axis) Single-pole roll off (SPR) low-pass filter for the cross-coupling error term that is multiplied times the "Split axis cross-coupling gain" (DataID 10339). The main purpose of this filter is to minimize the noise introduced by the cross coupling compensation. Setting the filter pole to 0 disables the filter. The system default value is 0. |
10342 |
Position feedforward gain |
Flt32 |
|
|
|
|
These parameters implement
non-linear position feedforward compensation. This was initially
developed to compensate for the spring force often present with voice
coil motors. If the gain and other applicable parameters
are non-zero, these parameters add a term to the servo's output torque
that is a function of the commanded motor position. |
10343 |
Motor neutral position, mcnt |
Flt32 |
|
|
|
|
|
10344 |
Position adjustment coefficient 0 |
Flt32 |
|
|
|
|
|
10345 |
Position adjustment coefficient 1 |
Flt32 |
|
|
|
|
|
10346 |
Position adjustment coefficient 2 |
Flt32 |
|
|
|
|
|
10347 |
Friction feedforward torque, tcnt |
Flt32 |
|
|
|
|
Friction feedforward torque is a constant torque that will add to
the final output of the compensator. The direction of
the friction feedforward torque depends on the commanded velocity.
This parameter is generally used to compensate for static friction
in the system. |
10348 |
Feedforward torque rate limit |
Flt32 |
|
|
|
|
Feedforward torque rate of change limit
in units of torque counts per servo execution period (tcnt/tick). This
limit prevents the feedforward torque from changing too fast. For
example, this can occur if an axis hits a soft stop limit in manual
control and the setpoint speed is spontaneously set to 0. Limiting
the rate of change of the feedforward torque can prevent the motor
from becoming unstable or from generating a large jerk. |
10349 |
Gravity compensation torque, tcnt |
Flt32 |
|
|
|
|
Adds a constant torque offset when an axis is either in position or torque control modes. This offset can be used to compensate for gravity in axes that are subject to a constant gravity force. For example, this term can be applied to the Z-axis for either a Cartesian or SCARA robot. |
10350 |
Integrator torque preload, tcnt |
Flt32 |
|
|
|
|
Immediately sets the integrator torque as displayed by "Integral torque" (DataID 12325) to a specified value. |
10351 |
Max positive torque limit for PID feedback, tcnt |
Flt32 |
|
0 |
FP32 |
|
These parameters limit the sum of the PID feedback output without affecting feedforward terms. These limits are especially useful for Z-axes with significant gravity loading. |
10352 |
Max negative torque limit for PID feedback, tcnt |
Flt32 |
|
-FP32 |
0 |
|
|
10353 |
Torque output filter pole, Hz #2 |
Flt32 |
|
|
|
|
Second set (of four sets) of torque output filters that are applied after the "Torque output filter pole" (DataID 10329) and "Torque output filter damping ratio" (DataID 10330). This cascaded set of four filters permits four distinct frequency ranges to be suppressed in the output of the servo feedback loop to reduce the possibility of exciting an oscillation in the axis. |
10354 |
Torque output filter damping ratio #2 |
Flt32 |
|
0.1 |
1 |
|
|
10355 |
Saved integrator torque preload, tcnt |
Flt32 |
|
|
|
|
Sets the integrator torque as displayed by "Integral torque" (DataID
12325) to a specified value each time that motor power is enabled. Once
the system completes its motor power enable sequence, the integrator
torque will be modified per the standard PID loop algorithm and the
value of the "Feedback compensator configuration" (DataID
10300). |
10361 |
Torque output filter pole, Hz #3 |
Flt32 |
|
|
|
|
Third set (of four sets) of torque output filters that are applied after the "Torque output filter pole #2" (DataID 10353) and "Torque output filter damping ratio #2" (DataID 10354). This cascaded set of four filters permits four distinct frequency ranges to be suppressed in the output of the servo feedback loop to reduce the possibility of exciting an oscillation in the axis. |
10362 |
Torque output filter damping ratio #3 |
Flt32 |
|
0.1 |
1 |
|
|
10363 |
Kd gain schedule, gain at zero speed, Kd |
Flt32 |
|
|
|
|
These two parameters implement a simple linear derivative gain adjustment (Kd gain scheduling). Systems with direct drive motors or low gear ratio axes are often under damped when the axis is not moving. However, increasing Kd can have the negative effect of generating unstable vibrations when the axis is moving at high speed. |
10364 |
Kd gain schedule, activate below speed, mcnt/sec |
Flt32 |
|
|
|
|
|
10365 |
Torque output filter pole, Hz #4 |
Flt32 |
|
|
|
|
Fourth set (of four sets) of torque output filters that are applied after the "Torque output filter pole #3" (DataID 10361) and "Torque output filter damping ratio #3" (DataID 10362). This cascaded set of four filters permits four distinct frequency ranges to be suppressed in the output of the servo feedback loop to reduce the possibility of exciting an oscillation in the axis. |
10366 |
Torque output filter damping ratio #4 |
Flt32 |
|
0.1 |
1 |
|
|
10367 |
Max torque limit for PID feedback after error, tcnt |
Flt32 |
|
|
|
|
When a severe error occurs (such as a "Hard envelope error" (-3100)), this parameter immediately takes effect and limits the sum of the PID feedback output without affecting feedforward terms (such as DFF, acceleration feedforward and gravity compensation). In the case of a "Hard envelope error", this prevents the position error feedback from driving against any object that is encountered. |
10368 |
Max torque limit for feedforward after error, tcnt |
Flt32 |
|
|
|
|
When a severe error occurs (such as a "Hard envelope error" (-3100)), this parameter immediately takes effect and limits the sum of the feedforward output (e.g. velocity (10337), acceleration (10336), friction (10347), gravity (10349), dynamic feedforward) without affecting the feedback torques. When a collision occurs, this feature limits the feedforward torque output, which were probably properly defined to drive an axis during normal operation, but may be excessive when the axis is in contact with an unexpected object. |
10369 |
PID output saturation duration limit, sec |
Flt32 |
|
0 |
1000 |
|
The maximum time, in seconds, that the sum of the PID loop feedback
terms can remain at its maximum value as defined by DataIDs 10351/10352).
If this time is exceeded, a -3101 "PID output saturated too long" error
occurs and robot power is disabled. |
10370 |
Integrator clear rate limit, tcnt |
Flt32 |
|
|
|
|
If the feature to zero the integrator when an axis is in motion
is enabled (bit 6 of the "Feedback compensator configuration", DataID
10300), this parameter defines how many tcnts the integrator
torque is reduced during each feedback compensator cycle. The
feedback compensator loop rate is set to 2kHz by default, so this parameter
typically sets the maximum reduction of the integral torque every 0.5
msec when a move starts. |
10371 |
Friction feedforward rate limit, tcnt |
Flt32 |
|
|
|
|
When the “Friction feedforward torque, tcnt” (DataID 10347) is non-zero and the direction of the commanded velocity is reversed, the sign of the friction torque compensation is spontaneously changed. If the friction feedforward torque is large, this can generate a sudden jerk in the compensator command. This rate limit smooths out this transition by gradually applying the change in the friction compensation. |