Professional Documents
Culture Documents
01 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.02 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.03 Path Planning
I. CUBIC PATH
• A cubic function is the simplest polynomial to determine the time
behavior of a variable between two given values
• A cubic path in joint space or in Cartesian space for a variable q(t),
between two points 𝑞 𝑡𝑜 and 𝑞 𝑡𝑓 is
𝑞 𝑡 = 𝑎𝑜 + 𝑎1 𝑡 + 𝑎2 𝑡 2 + 𝑎3 𝑡 3
With some constraints
𝑞 𝑡0 = 𝑞0 𝑞 𝑡0 = 𝑞0′
𝑞 𝑡𝑓 = 𝑞𝑓 𝑞 𝑡𝑓 = 𝑞𝑓′
So we have
𝑞𝑓 𝑡02 𝑡0 − 3𝑡𝑓 + 𝑞0 𝑡𝑓2 3𝑡0 − 𝑡𝑓 𝑞0′ 𝑡𝑓 + 𝑞𝑓′ 𝑡0
𝑎0 = − 3 − 𝑡0 𝑡𝑓 2
𝑡𝑓 − 𝑡0 𝑡𝑓 − 𝑡0
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.04 Path Planning
I. CUBIC PATH
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.05 Path Planning
I. CUBIC PATH
In case that 𝑡0 = 0, the coefficients simplify to
𝑎0 = 𝑞0
𝑎1 = 𝑞0′
3 𝑞𝑓 − 𝑞0 − 2𝑞0′ + 𝑞𝑓′ 𝑡𝑓
𝑎2 =
𝑡𝑓2
−2 𝑞𝑓 − 𝑞0 + 𝑞0′ + 𝑞𝑓′ 𝑡𝑓
𝑎3 =
𝑡𝑓3
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.06 Path Planning
I. CUBIC PATH
Example 348: (Rest-to-rest cubic path)
Assume 𝑞 0 = 10 deg, 𝑞 1 = 45 deg, and 𝑞 0 = 𝑞 1 = 0
The coefficients of the cubic path are
𝑎0 = 10, 𝑎1 = 0, 𝑎2 = 105, 𝑎3 = −70
That generate a path for the variable as
𝑞 𝑡 = 10 + 105𝑡 2 − 70𝑡 3 deg
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.07 Path Planning
I. CUBIC PATH
Example 349: (To-rest cubic path)
Assume the angle of a joint starts from 𝜃 0 = 10 deg, 𝜃 0 = 12 deg/s,
and ends at 𝜃 2 = 45 deg, 𝜃 2 = 0
The coefficients of a cubic path for this motion are
81 29
𝑎0 = 10, 𝑎1 = 12, 𝑎2 = , 𝑎3 = −
2 2
The kinematics of this path are
𝜃 𝑡 = 10 + 12𝑡 + 40.5𝑡 2 − 14.5𝑡 3
𝜃 𝑡 = 12 + 81𝑡 − 43.5𝑡 2 𝑑𝑒𝑔/𝑠
𝜃 𝑡 = 81 − 87𝑡 𝑑𝑒𝑔/𝑠 2
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.08 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.09 Path Planning
• The polynomials must then be joined together to satisfy all the required
boundary conditions
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.10 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.12 Path Planning
𝑞𝑛 𝑡 = 𝐿𝑖 𝑡 𝑞 𝑡𝑖
𝑖=0
𝑛
𝑡 − 𝑡𝑗
𝐿𝑖 𝑡 = 𝑖 = 0,1,2, ⋯ , 𝑛
𝑡𝑖 − 𝑡𝑗
𝑗=0,𝑗≠𝑖
Chebyshev
𝑞𝑛+1 𝑡 = 2𝑡𝑞𝑛 𝑡 − 𝑞𝑛−1 𝑡
𝑞0 𝑡 = 1 𝑞1 𝑡 = 𝑡
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.14 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.15 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.16 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.17 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.18 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.19 Path Planning
V. CARTESIAN PATH
• Cartesian path planning is mathematically similar to joint space path
planning
• Having the coordinates of the start and stop point of the end-effector in
Cartesian space as
𝑷0 = 𝑷0 𝑋0 , 𝑌0 , 𝑍0 𝑷1 = 𝑷1 𝑋1 , 𝑌1 , 𝑍1
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.20 Path Planning
V. CARTESIAN PATH
We can connect the points by a geometric space curve
𝑍=𝑍 𝑋 𝑌 = 𝑌(𝑋)
Where
𝑋 𝑡0 = 𝑋0 𝑋 𝑡𝑓 = 𝑋𝑓
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.21 Path Planning
V. CARTESIAN PATH
• A practical method is to design a path utilizing straight lines with
constant velocity, and deform the corners to have a smooth transition
• The path connecting points 𝐫0 to 𝐫𝟐 , and passing close to the corner 𝐫𝟏 on
a transition curve, can be designed by a piecewise motion
𝑡1 −𝑡
𝒓 𝑡 = 𝐫1 − 𝐫𝟏 − 𝐫0 𝑡0 ≤ 𝑡 ≤ 𝑡1 − 𝑡′
𝑡1 −𝑡0
2 2
𝑡−𝑡 ′ −𝑡1 𝑡+𝑡 ′ −𝑡1
𝒓 𝑡 = 𝐫𝟏 − 𝐫𝟏 − 𝐫0 + 𝐫𝟐 − 𝐫1
4𝑡 ′ (𝑡1 −𝑡0 ) 4𝑡 ′ 𝑡2 −𝑡1
𝑡1 − 𝑡 ′ ≤ 𝑡 ≤ 𝑡1 + 𝑡′
𝑡1 −𝑡
𝒓 𝑡 = 𝐫1 − 𝐫2 − 𝐫1 𝑡1 + 𝑡′ ≤ 𝑡 ≤ 𝑡2
𝑡2 −𝑡1
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.22 Path Planning
V. CARTESIAN PATH
• Transition parabola between two line segments as a path in Cartesian-
space is shown in the figure schematically
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.23 Path Planning
V. CARTESIAN PATH
Example 362: (A path in 2D Cartesian space)
Consider a line in the XY plane connecting (1,0) and (1,1), and another line
connecting (1,1) and (0,1).
Assume that time is zero at (1,0), is t=1 sec at (1,1), and is t=2 sec at (0,1)
For an interval time 𝑡 ′ = 0.1 𝑠𝑒𝑐, the position vector at control points are
𝐫𝟎 = 𝒊, 𝐫𝟏 = 𝒊 + 𝒋, 𝐫𝟐 = 𝒋
𝑡′ 𝑡′
𝐫 𝑡1 − 𝑡′ = 𝐫1 − 𝛅1 = 𝒊 + 1 − 𝒋
𝑡1 𝑡1
𝑡′ 𝑡′
𝐫 𝑡1 + 𝑡′ = 𝐫1 + 𝛅2 = 1 − 𝒊+𝒋
𝑡2 𝑡2
Where 𝛅𝟏 = 𝐫1 − 𝐫0 = 𝒋
𝛅2 = 𝐫2 − 𝐫1 = −𝒊
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.24 Path Planning
V. CARTESIAN PATH
The path of motion is then expressed by following piecewise functions
𝒊 + 𝑡𝒋 0 ≤ 𝑡 ≤ 0.9
𝑡 − 0.9 2 𝑡 − 1.1 2
𝐫 𝑡 = 1− 𝒊+ 1− 𝒋 0.9 ≤ 𝑡 ≤ 1.1
0.4 0.4
2−𝑡 𝒊+𝒋 1.1 ≤ 𝑡 ≤ 2
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.25 Path Planning
V. CARTESIAN PATH
Example 363: (A 2R manipulator following a line)
Assume the 2R manipulator has 𝑙1 = 𝑙2 = 0.25
And its tip point is supposed to move on a given line 𝑌 = 𝑓(𝑋)
𝑌 = −0.25988 𝑋 + 0.3705
The manipulator moves from 𝑷1 to 𝑷2 in 10 sec
𝑋𝑃1 = 0.41122
𝑌𝑃1 = 0.26359
𝑋𝑃2 = −2.8188 × 10−2
𝑌𝑃2 = 0.37783
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.26 Path Planning
V. CARTESIAN PATH
Let us define a rest-to-rest cubic path for X
𝑋 = 0.41122 − 0.01149096𝑡 2 + 0.000766064𝑡 3
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.27 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.28 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.29 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.31 Path Planning
• We may define a time path for one coordinate (X), and determine the time
history of the other coordinates by using geometric path
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.32 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.33 Path Planning
• It can control the level of force and jerk inserted by the hand of a robot
to the carrying object
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.34 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong
Robotics 13.35 Path Planning
HCM City Univ. of Technology, Faculty of Mechanical Engineering Phung Tri Cong