
Applied Mechanics - Department of Mechatronics - SME
O
q1
q3
q2
z0
x0
q4
q1
q3
q2q4
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 5.
ĐỘNG HỌC NGƯỢC ROBOT CHUỖI
Inverse kinematics of serial robots

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ử
1
2
O
q1
q3
q2
z0
x0
q4
Chương 5.
ĐỘNG HỌC NGƯỢC ROBOT CHUỖI
Inverse kinematics of serial robots

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 5.
ĐỘNG HỌC NGƯỢC ROBOT CHUỖI
Inverse kinematics of serial robots

Applied Mechanics - Department of Mechatronics - SME 4
Động học ngược robot nối tiếp
Inverse kinematics of serial robots
• Bài toán động học ngược
• Phương pháp giải tích (hình học + lượng giác)
• Phương pháp tách vị trí và hướng
• Phương pháp số - Newton-Raphson
• Chuyển bài toán động học ngược về bài toán tối ưu
• Giải động học ngược ở cấp độ vận tốc và gia tốc
Nguyễn Quang Hoàng
Email: hoang.nguyenquang@hust.edu.vn

Applied Mechanics - Department of Mechatronics - SME -5-
5
Bài toán động học ngược
Bài toán: Cho biết vị trí điểm tác động cuối E và hướng của khâu cuối
T
n
q q q
12
[ , ,..., ]q
T
E E E E
x y z 3,3
[ , , ] & ( , , )p R R
Xác định các tọa độ khớp (biến khớp):
O0q1
q2
q3
yE
xE
3
EE
x y q q q
3 1 2 3
[ , , ] [ , , ]
O0q1
q3
q4
q2
yE
xE
4
EE
x y q q q q
4 1 2 3 4
[ , , ] [ , , , ]

