Professional Documents
Culture Documents
∗
Div. of Electrical and Computer Eng., Pohang University
of Science and Technology, Pohang, 790-784, Korea
∗∗
POSCO Technical Research Lab., Pohang, 790-785,
Korea
Abstract: Trapezoidal velocity profiles are no longer sufficient for recent high speed
industrial robots involved in precision works. Most of the recently developed trajec-
tory generation algorithms have adopted jerk limited profiles, where computation
of the coefficients is intricate. The previous algorithms have attempted either to
obtain suboptimal solutions or to solve the problem in an iterative manner which
complicates on-line implementation. This paper presents analytic solutions to the
computational problem. The solutions presented are derived from the simultaneous
equations for displacement condition and peak velocity condition, where jerk,
acceleration and velocity constraints are resolved. By including only the low-order
polynomial equations that can be evaluated analytically, the proposed algorithm
c
is readily implementable on the fly. Copyright ° 2005 IFAC
(35)
D2 − A2
While a time-optimal problem always has a sin- − , A 6= D
J{(A + D)x + v0 − vf − DT }
gle solution that minimizes the traveling period γ= 2
A T
,A = D
T , any profile that satisfies the boundary con- J{(v0 + vf )T + (v0 − vf + AT )x − 2L}
ditions (p0 , pf , v0 , vf ) and the limit constraints (36)
(V, A, D, J) becomes a solution of the problem as CASE ( T4 = 0, T2 = 0, T6 > 0 )
long as its traveling period is T . In other words,
1 D2
additional criteria are required for choosing a so- vp = v0 + γJx2 = vf − + Dx̄ (37)
4 γJ
lution. The jerk-minimizing criterion is proposed
C2 x2 + C1 x + C0 = 0, where
in this paper, because, as jerk becomes smaller, DT 2
acceleration profile becomes smoother. Symbol γ C2 = (v0 − vf − )
2
is introduced to demonstrate the relation between C1 = −2vf T (DT + 2vf ) + T (v0 + vf )2 + 4L(vf − v0 ) + 2LDT
C0 = {2L − (v0 + vf )T }{2L − T (2vf + DT )}
a given jerk limit J and the effective jerk limit Je ,
(38)
where Je = γJ. 1 2 2 D2
Jx γ + (v0 − vf − Dx̄)γ + =0 (39)
The procedure to find a time-fixed solution is 4 J
similar to that of time-optimal solution. First,
CASE ( T4 = 0, T2 > 0, T6 = 0 )
determine whether the resultant profile is AFP
or DFP. Since the traveling period T is given, A2 1
one can simply decide it using (4). If the profile vp = v0 − + Ax = vf + γJ x̄2 (40)
γJ 4
is DFP, transform the problem into the corre-
sponding AFP problem. Second, by evaluating C2 x̄2 + C1 x̄ + C0 = 0, where
the simultaneous equations of the displacement AT 2
C2 = (vf − v0 − )
condition and the peak velocity condition, find 2
C1 = −2v0 T (AT + 2v0 ) + T (v0 + vf )2 + 4L(v0 − vf ) + 2LAT
x, x̄ and γ. The detailed procedure is described
C0 = {2L − (v0 + vf )T }{2L − T (2v0 + AT )}
later. In any case, x, x̄ and γ should satisfy (6),
(41)
(32a), and (32b).
1 2 2 A2
J x̄ γ + (vf − v0 − Ax)γ + =0 (42)
4 J
0 ≤ x, x̄, T − x − x̄ ≤ T, (32a)
CASE ( T4 = 0, T2 = 0, T6 = 0 )
0<γ≤1 (32b)
1 1
vp = v0 + γJx2 = vf + γJ x̄2 (43)
Third, readjust the acceleration, deceleration, 4 4
and jerk limits using equations (33a)∼(33c), if (v0 −vf )x2 +{(3vf +v0 )T −4L}x+{2L−(v0 +vf )T }T = 0
needed. (44)
4(v f − v 0 )
, vf 6= v0
2A γ= J(x2 − x̄2 ) (45)
A ← 0.5Jx, if x < (no const. acc.) (33a) 4(L/x − 2v0 ) , v = v0
γJ f
Jx2
2D
D ← 0.5J x̄, if x̄ < (no const. dec.) (33b)
γJ
J = Je ← γJ (33c)
Cases of constant velocity region
Finally, determine each time interval using (8)
with the adjusted A, D, J.
When the constant velocity region exists, vp be-
comes V for AFP problem. Provided that the ini-
tial or final velocity is given by V , the solutions of
Cases of no constant velocity region
x and γ are simply found. Therefore we subdivide
the condition into 7 cases instead of 4 cases.
With the similar approaches used for time-optimal
solutions, we divide the peak velocity condition CASE ( T4 > 0, T2 > 0, T6 > 0, v0 6= V, vf 6= V )
into four cases. For each case, we arrange the peak A2 D2
velocity condition, the equation for x or x̂, and V = v0 − + Ax = vf − + Dx̄ (46)
γJ γJ
³ ´
D
v0 − V + (vf − V ) x + 2V T − 2L
solution may not exist because the displacement
A µ ¶ condition and the limit constraints for jerk and
1 D2 (47)
+ (vf − V ) (v0 − V ) − v f + V =0 acceleration may contradict with one another.
D A2
Actually, when both v0 and vf are positive and the
A2 time-optimal solution is AFP, or when both v0 and
γ= (48)
J(Ax + v0 − V ) vf are negative and the time-optimal solution is
CASE ( T4 > 0, T2 = 0, T6 > 0, v0 6= V, vf 6= V ) DFP, time-fixed solutions do not exist for certain
values of T . Such cases should be avoided.
1 D2
V = v0 + γJx2 = vf − + Dx̄ (49)
4 γJ
D(vf − V ) 2 1
x + (v0 − V )x + 2V T − 2L − (vf − V )2 = 0 5. CONCLUSIONS
4(V − v0 ) D
(50)
4(V − v0 ) Operation of robots for precision works at high
γ= (51)
Jx2 speed requires not only high-performance feed-
CASE ( T4 > 0, T2 > 0, T6 = 0, v0 6= V, vf 6= V )
back controllers but also smooth reference pro-
file generation. Trajectories for industrial robots
A2 1 need continuous position, velocity, and accelera-
V = v0 − + Ax = vf + γJ x̄2 (52)
γJ 4 tion profiles with their derivative limits imposed
A(v0 − V ) 2 1 by the physical property of the actuators. More-
x̄ + (vf − V )x̄ + 2V T − 2L − (v0 − V )2 = 0
4(V − vf ) A over, they often require real-time implementation.
(53)
4(V − vf ) In jerk limited trajectory generation, jerk limited
γ= (54)
J x̄2 velocity profile plays a very important role for
CASE ( T4 > 0, T2 = 0, T6 = 0, v0 6= V, vf 6= V ) both path motions and point-to-point motions.
1 1
However, jerk limited velocity profile generation
v = v0 + γJx2 = vf + γJ x̄2 (55) is an intricate problem, and no analytic solutions
4 4
µ 3
¶ are found in the previous works.
(vf − V )
(v0 − V )2 − x2
(v0 − V ) (56) In this paper we developed analytic solutions to
−4(L − V T )(v0 − V )x + 4(L − V T )2 = 0 the jerk limited profile generation problem by
4(V − v0 ) dividing the problems into several cases using
γ= (57)
Jx2 the displacement conditions and the peak velocity
CASE ( T4 > 0, v0 = vf = V ) conditions. Since no iterative methods are used for
Since there are no acceleration and deceleration regions, solutions, the proposed solutions are essentially
the jerk scaling γ is meaningless, and we have the following. ready for real-time implementation.
x = x̄ = 0, x̂ = T (58)