
Applied Mechanics - Department of Mechatronics - SME
ROBOTICS
PGS. Nguyễn Quang Hoàng
ĐẠI HỌC BÁCH KHOA HÀ NỘI
TRƯỜNG CƠ KHÍ
NCM Cơ học ứng dụng - Khoa Cơ điện tử
Chương 10.
LẬP TRÌNH QUỸ ĐẠO
Trajectory planning

Applied Mechanics - Department of Mechatronics - SME
Chương 10.
LẬP TRÌNH QUỸ ĐẠO CHUYỂN ĐỘNG
Trajectory planning
Nguyễn Quang Hoàng
Email: hoang.nguyenquang@hust.edu.vn

Applied Mechanics - Department of Mechatronics - SME 3
Trajectory planning
nhanh
không gian
tự do
chậm
chậm
không gian chật hẹp,
có rào bảo vệ
Chuyển động trong không gian tự do và trong
không gian chật hẹp, có rào bảo vệ
điểm đầu
điểm cuối
A
B
Vật cản
Vật cản
điểm tựa
(trung gian)
Các điểm tựa khi thiết kế quỹ đạo quanh các
vật cản

Applied Mechanics - Department of Mechatronics - SME 4
Trajectory planning
1. Khái niệm đường di chuyển và quỹ đạo chuyển động
2. quỹ đạo nối điểm đầu điểm cuối
3. quỹ đạo qua các điểm tựa
4. Tạo luật chuyển động nhờ đa thức bậc 3, 5, 7
5. Tạo luật chuyển động nhờ các hàm điều hòa (sin, cos)
6. Thiết kế luật chuyển động trong không gian khớp
7. Thiết kế quỹ đạo trong không gian thao tác (đề các)
8. Đường spline bậc 3 (cubic S-pline) [remind Polynomial
interpolation; Lagrange polynomials are used
for polynomial interpolation, Newton interpolation]
Làm sao để robot thực hiện chuyển động theo
mong muốn của người sử dụng?

Applied Mechanics - Department of Mechatronics - SME 5
Trajectory planning –Motion planning
Động học:giải quyết các mối quan hệ hình học về vị trí / vận tốc
giữa không gia khớp q(t) và không gian thao tác (làm việc) x.
Động lực học:giải quyết mối quan hệ giữa mômen xoắn/lực tác
dụng tại các khớp và các chuyển động của các khâu.
Điều khiển: tính toán lực/mômen khớp cần thiết để thực hiện một
chuyển động mong muốn.
Thiết kế (hay lập kế hoạch) quỹ đạo:tạo ra chuyển động mong
muốn của các tay máy, đáp ứng yêu cầu nhiệm vụ đặt ra.
Thông thường, người dùng sẽ được yêu cầu để xác định một số
điểm và đặc tính chung của quỹ đạo (ví dụ như điểm ban đầu /
cuối cùng, thời gian, vận tốc tối đa, vv), và thực tế tính toán của
quỹ đạo được yêu cầu đến hệ thống điều khiển.

