Elmo HARSFEN0602 Network Hardware User Manual


 
HARSFEN0602
12.1.7 PT Motion
12.1.7.1 What Is PT
PT stands for Position-Time.
In a PT motion, the user specifies a sequence of absolute positions to be visited by the Amplifier with equal
time spaces. The time space must be an integer multiple of the Amplifier sampling time. Between the user
specified positions, the Amplifier interpolates smooth motion.
The position specifications are absolute.
Interpolation Mathematics
PT implements a 3
rd
order interpolation between the position data points provided by the user.
Let
s
TmT =
Where:
s
T is the sampling time of the position controller. The parameter WS[29] reads
s
T .
T is the sampling time of the PT trajectory
m
(The system parameter MP[4]) is the integer parameter relating
s
T and T.
For the case
1
m
, no interpolation is required.
For
1
m
, there are sampling instances of the position controller for which the path command must be
interpolated. We use a 3
rd
order polynomial interpolation.
The user provides the position points
N...1k),k(P = .
The Amplifier calculates the speeds
N...1k),k(V = for the points N...1k),k(P = as follows:
If
k
is an ordinary point inside the path:
T
2
)1k(P)1k(P
)k(V
+
=
If
k
is the first programmed point in the path:
T
)k(P)1k(P
)k(V
+
=
If
k
is the last programmed point in the path:
T
)1k(P)k(P
)k(V
=
For each motion interval, we have four requirements to satisfy:
Start position.
End position.
Start speed.
End speed.
These four requirements exactly suffice to solve the interpolating 3
rd
order interpolating polynomial.
12.1.7.2 Example
Consider the position controller reference signal )t102sin()t(P π= where t is the time in seconds.
The controller has a position sampling time of 200 microseconds.
The path is programmed with a data point once per MP[4]=50 controller sampling-times (10msec).
The set of PT reference points are below depicted in circles.
The path interpolated by the Amplifier is shown as a solid line.