Baldor Flex+DriveII, Installation Manual

Page: 112 / 126

B-6 Control System MN1902
B.2 Control system operation
The following sections describe the operation of the position, speed and torque controllers.
B.2.1 Position controller
The position controller, shown below, is a typical propor in derivative (PID)
controller, with gains set by the Mint keywords
KPROP , KINT and KDERIV . The position
demand from the profiler is compared with the measured position and the error is fed into the
PID control calculation. The resulting value forms the basic speed or torque demand,
depending on the
CONFIG
setting. The effect of the integral term can be changed using the
KINTLIMIT
and
KINTMODE
keywords.
KINTLIMIT
sets the maximum value of the effect of
integral action, as a percentage of the full scale demand.
KINTMODE
can be used to specify
the circumstances under which the integral term is applied.
As an alternative to the derivative term, a velocity feedback term is available by setting
keyword
KVEL
.
To improve the tracking performance of the position controller, the profiler speed is fed forward,
by gain
KVELFF
, to give a contribution to the final speed or torque demand. The profiler
acceleration is fed forward by gain
KACCEL
to give a contribution to the final speed demand.
The position control calculation is performed every 500µs.
The gain values KPROP , KINT , KDERIV , KVEL , KVELFF and KACCEL must be tuned for each
application. This can either be performed automatically within the Commissioning Wizard, or
manually using the Fine-tuning tool in WorkBench v5.
KVELFF
KPROP
KINT
KDERIV
KVEL
dt
d
dt
Following
error
(FOLERROR)
Proportional gain term
Integral gain term
Derivative gain term
Velocity feedback
term
Measured speed
(VEL)
Speed demand
Measured position
(POS)
Velocity feedforward term
Profiler speed
(VELDEMAND)
Profiler position
(POSDEMAND)
+
+
+
+
+
+
-
-
Figure 47 - Position control system