Professional Documents
Culture Documents
ĐỀ 2:
Câu 1: (4 điểm)
a. (3)
Tìm ma trận chuyển đổi 0Tn
T
b. (5)
Cho điểm n P = Px Py Pz thuộc On . Tìm 0 P thuộc O0
0
Tìm P thuộc O0
Câu 2: (6 điểm)
a. (2)
Đặt hệ trục tọa độ DH lên các khớp
b. (2)
Xác định bộ thông số DH
c. (3)
Tìm ma trận chuyển đổi thuần nhất Tn0 .
(4)
Suy ra ma trận hướng và ma trận vị trí điểm cuối
của tay máy
d. (1)
Vẽ tay máy khi l1=40cm; l2 =30cm; l3=25cm;
θ1=45o; θ2=135o; θ4=-150o;
Giảng viên ra đề
1 - T(O0,On)
0
T1 =
Ry,( π – β-(π/2-α))
1
T2 =
- Rx,π/2
2
T3 =
0
T3 =0 T11T22T3 =
c.
0
P =0 T3n P =
=
c. Thay số:
0
P=
Link θ α a d
1 θ1 90 0 l1
2 θ2 90 0 0
3 0 -90 0 l2
4 θ3 0 l3 0
Ma trận
T1= T2=
T3= T4=
T=T1 T2 T3 T4 =
Ma trận hướng
Ma trận vị trí