CHƯƠNG 1. THIẾT LẬP PHƯƠNG TRÌNH CHUYỂN ĐỘNG CỦA ROBOT PHẲNG CÓ KHỚP NỐI ĐÀN HỒI 1. Phương trình lagrange loại hai của robot có khớp nối đàn hồi 1. Mô hình hóa Robot có khớp nối đàn hồi , và các kh 3 Hình 1.
Khớp đàn hồi Harmonic mô hình nhau.2: Robot nhẹ DLR LWR-III 7R có khớp nối đàn hồi n c 5 Hình 1.3 Mô hình hóa robot N khâu có khớp nối đàn hồi 1. Mô hình hóa khớp nối đàn hồi 6 là t suy rnh v trí ca các khâu 1. Thiết lập phương trình Lagrange loại II Định nghĩa 1 1) ¸ (1.1) là ma tr 2) (1.3) K Định nghĩa 2 ng quát (complete model). trình Lagrang II 7 M (q )q& &C (q ,q&& q ) g q( ) K q( θ ) 0 (1.
Phương trình lagrange loại hai của robot hai khâu và ba khâu phẳng có khớp nối đàn hồi 1.1 Robot phẳng có 2 khâu vơí khớp đàn hồi Thanh l1 12 2 Hình 1. Mô hình thực tế của robot phẳng có khớp nối 2. Robot phẳng 2 khâu có khớp nối đàn hồi Bảng 1. Thông số Robot Cách 1.
Thiết lập phương trình Lagrange loại II dạng thường 10 Động năng của hai khâu: (1.2) Thế năng trọng lực (1.3) Cơ năng của hai motor Động năng roto của hai mô tơ (1.4) Thế năng đàn hồi (1.5) Cơ năng của cả cơ hệ: Động năng: 11 (1.8) i din cho vector t suy rng, Phương trình thứ nhất: Phương trình thứ hai: 12 hay Phương trình thứ ba: Phương trình thứ tư: 13 (1.10) Cách 2: Thiết lập phương trình Lagrange loại II dạng ma trận Bảng 1. Thông số động học Craig robot 2 khâu Khâu 1 0 0 0 2 0 0 Bảng 1. Tham số động lực học của robot 2 khâu Khâu Vị trí trọng tâm Khối Ma trận mômen quán tính I lượng 1 0 0 0 0 0 0 2 0 0 0 0 0 0 Động năng của hai khâu: 14 n khng suy rng hai khâu có dng: (1.12) 15 Động năng của hai mô tơ (1.13) Vi và Thế năng đàn hồi của hai lò xo (1.14) Vi ; và ; Thế năng trọng lực của robot (1.2 Robot phẳng 3 khâu có khớp đàn hồi 1, m2 , m3, l1, l2, l3. 1, C2,, C3, 17 t lên các khâu Hình 1.
Robot phẳng 3 khâu có khớp nối đàn hồi ta mô hì2.b Mô hình hóa Robot phẳng 3 khâu có khớp nối Bảng 1. Thông số Robot phẳng 3 khâu có khớp nối đàn hồi Mô men quán qua 19 Thiết lập phương trình Lagrange loại II dạng ma trận Bảng 1. Thông số động học Craig robot 3 khâu Khâu 1 0 0 0 2 0 0 3 0 0 Bảng 1.