Động lực học ngược của rô bốt song song 3RRR

Chia sẻ: _ _ | Ngày: | Loại File: PDF | Số trang:6

Thêm vào BST

Báo xấu

22
lượt xem 2
download

Download Vui lòng tải xuống để xem tài liệu đầy đủ

Trong bài viết này khi giải quyết bài toán động lực học ngược của robot song song dựa trên ý tưởng xem đây là bài toán điều khiển chương trình, đó là xác định động lực lên các khâu dẫn để khâu thao tác thực hiện chuyển động yêu cầu được cho dưới dạng bài toán không cần đến phương trình động học, ví dụ như khi thực hiện quỹ đạo theo yêu cầu.

Chủ đề:

Bình luận(0) Đăng nhập để gửi bình luận!

Lưu

Nội dung Text: Động lực học ngược của rô bốt song song 3RRR

Tuyển tập Hội nghị khoa học toàn quốc lần thứ nhất về Động lực học và Điều khiển Đà Nẵng, ngày 19-20/7/2019, tr. 190-195, DOI 10.15625/vap.2019000277 Động lực học ngược của rô bốt song song 3RRR Đỗ Đăng Khoa1), Ngô Hồng Đăng2), Phan Đăng Phong2), Đỗ Sanh1) 1) Trường Đại học Bách khoa Hà Nội,2)Viện Nghiên cứu Cơ khí Email: dangnh@narime.gov.vn Tóm tắt phương pháp này sẽ xuất hiện các thông số phụ (các nhân Robot song song đang được sử dụng rộng rãi trong nhiều lĩnh tử Lagrange) và đặc biệt xuất hiện các nội lực (mặc dù vực như vấn đề tác hợp gia công cơ khí thực hiện nhiều nguyên yêu cầu của bài toán không cần đến). công đồng thời, vấn đề phân tải trong quá trình vận chuyển, Để khảo sát loại bài toán này, về mặt động học, xem thao tác của robot. Tuy nhiên đây là loại cơ cấu có cấu trúc Robot song song như là cơ cấu nối ghép các chuỗi động phức tạp. Hiện nay thường sử dụng hai phương pháp cho việc và trên cơ sở đó có thể sử dụng phương pháp ma trận khảo sát loại cơ cấu này: Phương pháp nhân tử Lagrange và truyền, nhờ đó có thể tính các đại lượng động học của Phương pháp tách cấu trúc. rôbốt phức tạp và về mặt động lực áp dụng phương trình Trong bài báo này khi giải quyết bài toán động lực học ngược Lagrange dạng ma trận loại trừ các nhân tử Lagrange dù của robot song song dựa trên ý tưởng xem đây là bài toán điều rô bốt song song là các cơ hệ chịu liên kết khiển chương trình, đó là xác định động lực lên các khâu dẫn để khâu thao tác thực hiện chuyển động yêu cầu được cho dưới 2. Nội dung khảo sát dạng bài toán không cần đến phương trình động học, ví dụ như Trong báo cáo khảo sát Robot song song phẳng khi thực hiện quỹ đạo theo yêu cầu. Với quan điểm này các tác 3RRR như Hình 1. Robot này có thể xem như được ghép giả đã đề xuất phương pháp gồm hai bước: bởi hai chuỗi nối tiếp : Bước 1: Sử dụng phương pháp ma trận giải bài toán động học Chuỗi 1: 01ABCE05: gồm 2 khâu quay, và 3 khâu song để xác định trạng thái động học yêu cầu; phẳng. Bước 2: trên cơ sở Bước 1, Sử dụng phương trình động lực Chuỗi 2: 01ABDF07 cũng 2 khâu quay và 3 khâu song dạng ma trận để xác định động lực thỏa mãn yêu cầu đặt ra với phẳng. ý tưởng dựa trên Nguyên lý Phù hợp buộc các yếu tố động lực Đây là hai chuỗi nối tiếp nối ghép nhờ khâu tam giác phải đáp ứng các yêu cầu từ trạng thái động học. đều BCD có chuyển động song phẳng Yêu cầu đặt ra là trọng tâm C3 của tam giác đều ABC Từ khóa. Phương pháp ma trận truyền, Phương trình động lực phải chuyển động theo luật xác định: dạng ma trận, Nguyên lý Phù hợp, Robot song song, Bài toán 0 xC 3 = x0 + H 0 cos(t ); Điều khiển chương trình. yC 3 = y0 + H 0 sin t ; 0 (1) 1. Mở đầu  = 0 (1 − sin t ); Robot song song đang được sử dụng rộng rãi trong nhiều lĩnh vực như vấn đề tác hợp gia công cơ khí thực hiện nhiều nguyên công đồng thời, vấn đề phân tải trong quá trình vận chuyển, thao tác của robot. Các vấn đề này được quan tâm bởi nhiều tác giả không những từ các nhà khoa học nước ngoài [4,5] và bắt đầu có nhiều quan tâm của các nhà khoa học trong nước [1,2,3]. Sự phức tạp đối với loại Robot song song là sự ghép nối các chuỗi hở và các chuỗi kín, vì thế liên kết với nhau bởi nhiều phương trình liên kết. Hiện nay để khảo sát loại rô bốt này phải sử dụng phương trình dạng nhân tử (do có phương trình liên kết), phương pháp tách cấu trúc (để tách các chuỗi động). Do đó khi sử dụng phương pháp này phải sử dụng đồng thời cả hai phương pháp được sử dụng trong động lực Hình 1. Robot song song 3RRR học: Phương pháp phương trình Lagrange dạng nhân tử, Phương pháp D’Alembert. Khi sử dụng đồng thời hai
Đỗ Đăng Khoa, Ngô Hồng Đăng, Phan Đăng Phong, Đỗ Sanh Trong đó  là góc quay tuyệt đối của khâu tam giác, cos q7 − sin q7 −l2  l1  l1  t7 =  sin q7 cos q7 0  ; r5 =  0  : r7 =  0  ; x0,y0, 0 , 0 là các hằng số đã cho.  0 0 1   1   1      Yêu cầu này tương đương với thực hiện chuyển động cos(q3 + 3 ) − sin(q3 + 3 l2    chương trình được viết trong dạng sau:   (3) t0 =  sin(q3 + ) cos(q3 + ) 0   3 3    0 xC 3 − x0 − H 0 cos(t ) = 0;  0 0 1   0 yC 3 − y0 − H 0 sin(t ) = 0; (2)  − 0 (1 − sin t ) = 0; Các liên kết chương trình được viết như sau: Bài toán đặt ta là xác định các mômen động lực f1=-h1cos(q1+q2+q3)-h2sin(q1+q2+q3)- M1,M5,M7 tác dụng lên các khâu có các trục quay 01,05,07 l2cos(q1+q2 )+l1cosq1-x30-Rcos t ) =0; để tay máy thực hiện chuyển động chương trình yêu cầu (2). f2=h1sin(q1+q2+q3)+h2cos(q1+q2+q3) (4) Các khâu quay được xem là những thanh được cân -l2sinq1-y30-Rsin t =0; bằng, tức khối tâm của chúng rơi vào trục quay, có mômen quán tính khối đối với trục quay có giá trị bằng f3=q1+q2 +q3- 0 (1- sin t ) =0; nhau và bằng J1, có cùng chiều dài l1, các thanh chuyển động song phẳng AB, CE, DF được xem là đồng chất, Các phương trình liên kết (vật chất) được rút ta từ điều có cùng chiều dài l2, khối lượng là m2 và mômen quán kiện: tính đối với khối tâm là J2. Tấm tam giác BCD, có dạng 0 r5 = t1t2t3t4t5 r5 : 0 r7 = t1t2t0t6t7 r7 (5) tam giác đều cạnh bằng h, trọng tâm tại C3, khối lượng m3 và mô men quán tính đối với khối tâm J3. Khi triển khai chúng có dạng sau: Bài toán gồm hai bước: Bước 1. Xác định trạng thái động học theo yêu cầu đặt ra f4=l1cos(q1+q3+q4+q5)+l2cos(q1+q2+q3+q4)-hcos(q1+ Chọn các tọa độ suy rộng là các góc q2+q3)+l2cos(q1+q2)+l1cosq1-L1=0; f5=l1sin(q1+q3+q4+q5)+l2sin(q1+q2+q3+q4)-hsin(q1+q 1 ,2 ,3 ,4 ,5 ,6 ,7 như hình vẽ. Do các trục 2+q3)-l2sin(q1+q2)+l1sinq1=0; 01,05,07 cố định, có thể viết 4 phương trình liên kết nên hệ f6=l1cos(q1+q2+q3+  +q6+q7)-l2cos(q1+q2+q3++q6) có 3 bậc tự do, ứng với 3 tọa độ độc lập, có thể chọn, ví -hcos(q1+q2+q3+  )-l2cos(q1+q2)+l1cosq1-0.5L1=0; f7=l1sin(q1+q2+q3++q6+q7)-l2sin(q1+q2+q3+α+q6) dụ, 1 ,5 ,7 . Để viết các phương trình liên kết ta sử -hsin(q1+q2+q3+)-l2sin(q1+q2)+l1sinq1-L2=0. phương pháp ma trân truyền. (6) Thiết lập các ma trận với các tham số sau: Yêu cầu đối với chuyển động của robot là phải thỏa mãn hệ phương trình liên kết chương trình (4) và các liên kết qi  i ; qi  i ; qi  i ;(i = 1,7) vật chất (6),tức: cos q1 − sin q1 0 cos q2 − sin q2 l1  fi = 0 ; i = 1, 7 (7) t1 =  sin q1 cos q1 0  ;t2 =  sin q2 cos q2 0  ;   0 0 1   0 0 1  Để giải quyết bài toán đặt ra là robot cần phải thỏa mãn hệ phương trình này không những chỉ với trạng thái vị trí cos q3 − sin q3 l2  cos q4 − sin q4 −h  của robot tại mọi thời điểm mà còn với trạng thái vận tốc t3 =  sin q3 cos q3 0  ;t4 =  sin q4 cos q4 0  ; và trạng thái gia tốc, tức không những chỉ hệ 7 phương  0 0 1   0 0 1  trình trên mà còn từ các phương trình nhận được từ hệ 1 0 l2  cos q6 − sin q6 −h  phương trình này sau khi đạo hàm bậc nhất và bậc hai t5 = 0 1 0  ; t 6 =  sin q6   0  ; theo thời gian. Để nhận được những phương trình này ta cos q6 đưa vào các đại lượng sau: 0 0 1   0 0 1  fi fij = : i, j = 1,7; (8) q j Hệ phương trình cần thỏa mãn đối với trạng thái vận tốc:
Động lực học ngược của Rô bốt song song 3RRR 7 f ij  − sin q2 cos q2 0 Fi =  q j = 0; i = 1,7 T2 = t =  − cos q2 0  ; (9) j =1 q j T 21 − sin q2  0 0 0  Còn hệ phương trình thỏa mãn đối với trạng thái gia tốc: Các ma trận xác định vị trí khối tâm các khâu: 7 7 fij Gi =  fij q j +  q q q = 0; i = 1,7 (10) j =1 r , j =1 r r j l1  c2   h1  c4        C1 =  0  ;C 2 =  0  ;C3 =  h2  ;C 4 =  0  ; Từ hệ phương trình (7),(9),(10) với điều kiện đầu xác  1   1   1   1  định ta xác định được trạng thái động học yêu cầu đối với robot, tức xác được yêu cầu động học theo yêu cầu đặt ra l1  c6  l1     C5 =  0  ;C 6 =  0  ;C 7 =  0  : D1 = 0 0 1 ; {q1(t),q2(t),q3(t),q3(t),q4(t),q5(t),q6(t),q7(t)} (11)  1   1   1  D2 =  c2 0 1 : D3 =  h1 h2 1 : D4 =  c4 0 1 ; Trong trường hợp đơn giản trạng thái động học theo biến D5 = l1 0 1; D6 =  c6 0 1; D7 = l1 0 1 thời gian có thể xác định trực tiếp từ hệ phương trình (7). Bước 2. Xác định động lực đáp ứng trạng thái động học (13) yêu cầu (7), (9), và (10) Ma trận quán tính được tính theo công thức sau: Sau khi xác định được trạng thái động học theo yêu cầu, ta có thể xác định các động lực cần thiết (trong a11=m2D2T2T11t11t2C2+m3D3T3.T2T11t11t2t3C3+m4D4T4 trường hợp này là các mômen M1,M5,M7. Để xác định các T3T2T11t11t2t3t4C4+m5D5T5T4T3T2T11t11t2t3t4t5C5+m6D6 đại lượng này ta sử dụng phương trình động lực dạng ma T6T0T2T11t11t2t0t6C6+m7D7T7T6T0T2T11t11t2t0t6t7C7: trận [9,11]. Ta xây dựng thêm các ma trận sau: a11=m2D2T2T11t11t2C2+m3D3T3.T2T11t11t2t3C3+m4D4T4 T3T2T11t11t2t3t4C4+m5D5T5T4T3T2T11t11t2t3t4t5C5+m6D6  − sin q1 − cos q1 0   − sin q2 − cos q2 0 T11 =  cos q1 − sin q1 0  ;T21 =  cos q2 − sin q2 0  ; T6T0T2T11t11t2t0t6C6+m7D7T7T6T0T2T11t11t2t0t6t7C7: a12=m2D2T21T1t11t2C2+m3D3T3.T2T11t1t21t3C3+m4D4T  0 0 0   0 0 0  4T3T21T1t1t21t3t4C4+m5D5T5T4T3T21T1t11t2t3t4t5C5+m6D  − sin q3 − cos q3 0   − sin q4 − cos q4 0 6T6T0T21T1t11t2t0t6C6+m7D7T7T6T0T21T1t11t2t0t6t7C7: T31 =  cos q3 − sin q3 0  ;T41 =  cos q4 − sin q4   0  ; a13=m3D3T31.T2T1t11t2t3C3+m4D4T4T31T2T1t11t2t3t4C4+  0 0 0   0 0 0  m5D5T5T4T31T2T1t11t2t3t4t5C5+m6D6T6T01T2T1t11t2t0t6C 6+m7D7T7T6T01T2T1t11t2t0t6t7C7:  − sin q5 − cos q5 0   − sin q6 − cos q6 0  T51 =  cos q5 − sin q5 0  ;T61 =  cos q6  − sin q6 0  ; a14=m4D4T41T3T2T1t11t2t3t4C4+m5D5T5T41T3T2T1t11t2t3 t4t5C5;  0 0 0   0 0 0  a15= m5D5T51T4T3T2T1t11t2t3t4t5C5; a16=m6D6T61T0T2T1t11t2t0t6C6+m7D7T7T61T0T2T1t11t2t0  − sin q7 − cos q7 0  T71 =  cos q7 − sin q7 0  ; t6t7C7: a17= m7D7T71T6T0T2T1t11t2t0t6t7C7;  0 0 0  a22=m2D2T21T1t1t21C2+m3D3T3.T21T1t1t21t3C3+m4D4T4 (12)  − sin(q3 +  ) − cos(q3 +  ) 0  T3T21T1t1t21t3t4C4+m5D5T5T4T3T21T1t1t21t3t4t5C5+m6D6 T01 =  cos(q3 +  ) − sin q(q3 +  ) 0  ; T6T0T21T1t1t21t0t6C6+m7D7T7T6T0T21T1t1t21t0t6t7C7: a23=m3D3T31.T2T1t1t21t3C3+m4D4T4T31T2T1t1t21t3t4C4+  0 0 0  m5D5T5T4T31T2T1t1t21t3t4t5C5+m6D6T6T01T2T1t1t21t0t6C Ở đây sử dụng ký hiệu chữ viết hoa là ma trận chuyển vị 6+m7D7T7T6T01T2T1t1t21t0t6t7C7; ứng với chữ viết thường, ví dụ, T1 là ký hiệu ma trận a24=m4D4T41T3T2T1t1t21t3t4C4+m5D5T5T41T3T2T1t1t21t3 chuyển vị của ma trân t1,T21 là ma trận chuyển vị của ma t4t5C5; trận t21, tức: a25= m5D5T51T4T3T2T1t1t21t3t4t5C5;  cos q1 sin q1 0 a26= T1 = t =  − sin q1 cos q1 0 ; T m6D6T61T0T2T1t1t21t0t6C6+m7D7T7T61T0T2T1t1t21t0t6t7C 1 7;  0 0 1  a27= m7D7T71T6T0T2T1t1t21t0t6t7C7; a33=m3D3T31.T2T1t1t2t31C3+m4D4T4T31T2T1t1t2t31t4C4+ m5D5T5T4T31T2T1t1t2t31t4t5C5+m6D6T6T01T2T1t1t2t01t6C 6+m7D7T7T6T01T2T1t1t2t01t6t7C7;
Đỗ Đăng Khoa, Ngô Hồng Đăng, Phan Đăng Phong, Đỗ Sanh a34=m4D4T41T3T2T1t1t2t31t4C4+m5D5T5T41T3T2T1t1t2t31 và lực cản nhớt được tính từ hàm hao tán  , chúng là t4t5C5; a35=m5D5T51T4T3T2T1t1t2t31t4t5C5; những ma trận cỡ (nx1): a36=m6D6T61T0T2T1t1t2t01t6C6+m7D7T7T61T0T2T11t11t2t 7 01t6t7C7; Qiqt1 = 0.5YDi AX ; i = 1,7 ; Q qt 2 =  Di AX i : i =1 a37=m7D7T71T6T0T2T1t1t2t01t6t7C7;     a44=m4D4T41T3T2T1t1t2t3t41C4+m5D5T5T41T3T2T1t1t2t3t Q1 = M 1 − − : Q5 = M 5 − − : q1 q1 q5 q5 41t5C5;     a45= m5D5T51T4T3T2T1t1t2t3t41t5C5; Q7 = M 7 − − : Qr = − − ;(r = 2,3, 4,6) q7 q7 qr qr a46=0; a47=0; (16) a55= m5D5T51T4T3T2T1t1t2t3t4t51C5; Trong đó thế năng của tay máy có dạng: a56=0;  = m2 gy2 + m3 gy3 + m4 gy4 + m5 gy5 + m6 gy6 + m7 gy7 a57=0; a66=m6D6T61T0T2T1t1t2t0t61C6+m7D7T7T61T0T2T1t1t2t0t Với y2,y3,y4,y5,y6,y7 là tung độ của các trọng tâm các 61t7C7; khâu, được tính từ công thức: a67=m7D7T71T6T0T2T1t1t2t0t61t7C7; r20 = t1t2 r2 ; r30 = t1t 2 t3 r3 ; r40 = t1t2 t3 t4 r4 ; r60 = t1t 2 t3 t0 t6 r6 a77= m7D7T71T6T0T2T1t1t2t0t6t71C7; (14) Từ đây tính được:  a11 a12 a13 a14 a15 a16 a17  y2 = c2 sin(q1 + q2 ) + l1 sin q1 ;  qi qi qi qi qi qi qi  y3 = h1 sin(q1 + q2 + q3 ) + h2 cos(q1 + q2 + q3 )    a12 a22 a23 a24 a25 a26 a27  +l2 sin(q1 + q2 ) + l1 sin q1 ;  qi qi qi qi qi qi qi   y4 = c4 sin(q1 + q2 + q3 + q4 ) − h sin(q1 + q2 + q3 )  a13 a23 a33 a34 a35 a36 a37  +l2 sin(q1 + q2 ) + l1 sin q1 ;   qi qi qi qi qi qi qi   y6 = c6 sin(q1 + q2 + q3 +  + q6 ) − h sin(q1 + q2 + q3 +  )  a14 a24 a34 a44 a45 a46 a47  Di A =  : −l2 sin(q1 + q2 ) + l1 sin q1 ;  qi qi qi qi qi qi qi  Từ phương trình liên kết (vật chất) được viết trong quan  a15 a25 a35 a45 a55 a56 a57    hệ gia tốc ta tính được biểu thức gia tốc của các gia tốc  qi qi qi qi qi qi qi  phụ thuộc trong dạng:  a16 a26 a36 a46 a56 a66 a67     qi qi qi qi qi qi qi  qr = d r1q1 + d r 5 q5 + d r 7 q7 + ....; r = 2,3, 4,6 (17)  a17 a27 a37 a47 a57 a67 a77    Ở đây các đại lượng không viết không chứa các gia tốc  qi qi qi qi qi qi qi  Hàm hao tán  có dạng  q1   q1qi   q   qq   2   2 i  1 7  q3   q3qi  = bi q2 2 i =1     X =  q4  : X i =  q4 qi  : i = 1, 7 Phương trình chuyển động của robot được viết trong dạng  q5   q5 qi  (15) sau [10,11]:      q6   q6 qi   q   qq  ak1q1 + ak 2 q2 + ak 3 q3 + ak 4 q4 + ak 5 q5 + ak 6 q6 +  7   7 i    Y =  q1 q2 q3 q4 q5 q6 q7  ak 7 q7 − M k + + − Qkqt1 + Qkqt 2 = 0; qk qk Để thiết lập phương trình chuyển động dạng ma trận  r = 2,3,4,6 d rk (a1r q1 + a2 r q2 + a3r q3 + a4 r q4 + a5 r q5 + (18) [11] cần phải tính lực suy rộng do quán tính của cơ hệ,   qt1 a6 r q6 + a7 r q7 + + Qr + Qrqt 2 ) = 0; gồm Qqt1 , Qqt 2 và lực suy rộng của các lực tác dụng Q qr qr gồm các mômen tác dụng lên khâu chủ động k = 1,5,7; aij = a ji (i, j = 1, n) (M1,M5,M7), của các lực có thế (thế năng của trọng lực)
Động lực học ngược của Rô bốt song song 3RRR Ta nhận được Hệ 3 phương trình (18). Từ đây tính được các mômen khâu dẫn: 7   7   M k =  akj q j + + +  d rk ( a jr q j + + ): j =1 qk qk r j =1 qr qr k= 1,5,7 (19) Dựa vào Nguyên lý Phù hợp [9-11] các mômen động lực Mk ( k = 1,5,7 ) sẽ đáp ứng yêu cầu đặt ra khi thay vào các biểu thức (18) nghiệm của lời giải động học từ hệ phương trình (8,9,10), tức sử dụng hệ nghiêm (11). Kết quả xử lý bằng số sử dụng phần mềm Maple với các số liệu: l1 = 0.3(m); l2 = 0.6(m); =  / 3( rad ); h = 0.6( m); Hình 2. Mômen động lực M1 J1 = 0.02(kgm 2 ); J 2 = 0.3(kgm 2 ); J 3 = 0.05( kgm 2 ); m1 = 3(kg ); m2 = 1(kg ); m3 = 5( kg ); bi = 0;1(i = 1,7);  g = 10m / s 2 ;  = (rad / s ); H =  / 12; 3 L1 = (1.5l2 + h)(m); L2 = 0.5 3h + 2.8l2 (m), x03 = 0.5(l1 + 3l2 + h2 − 3h1 ) − R(m); y03 = 0.5(l1 3 + l2 − h1 − 3h2 ) − R(m); h1 = −0.5l2 (m); h2 = −0.5l2 (m); c1 = 0(m); c2 = −0.5l2 (m); c4 = 0.5l2 (m);; c6 = 0.5l2 (m);  0 = ; R = 0.15(m); 8 Điều kiện đầu: Hình 3. Mô men động lực M5 q1 (0) =  / 3(rad ); q2 (0) = 5 / 6(rad ); q3 (0) = 0( rad ); q4 (0) =  / 3(rad );q 5 (0) =  / 6( rad );q 6 (0) =  / 6( rad ); q7 (0) =  / 3(rad ); q1 (0) = 0(rad / s); q2 (0) = 0( rad / s); q3 (0) = 0(rad / s); q4 (0) = 0( rad / s); q5 (0) = 0(rad / s); q6 (0) = 0( rad / s); q7 (0) = 0(rad / s). Kết quả tính toán các mômen động lực Mk (k=1,5,7) theo phương pháp trên được thể hiện trên đồ thị Hình 2, 3, và 4, là các mômen cần thiết để bàn máy thực hiện chuyển động theo yêu cầu (1) có dạng: xp = g1(t); yp = g2(t); =g3(t), tức phải với thực hiện điều kiện (4), có dạng: f1 = xp – g1(t) = 0; f2 = yp – g2(t)=0; f3 = -g3(t)=0. Từ đồ thị được thể hiện trên Hình 5 cho thấy phương pháp đề xuất trong báo cáo là có thể tin cậy. Hình 4. Mômen động lực M7
Đỗ Đăng Khoa, Ngô Hồng Đăng, Phan Đăng Phong, Đỗ Sanh trình khoa học Hội nghị Cơ học Toàn quốc lần thứ 10, Hà nội, 08-09/12/2017, tr.827-836. [4] Merlet J.P., Paralell Robots, London Kluwer Academic Publishers Dordrecht (2000), Tuyển tập công trình khoa học Hội nghi Cơ học Toàn quốc lần thứ 10, Hà nội, 08-09/12/2017. [5] Staicu S., Matrix Modeling of Inverse Dynamics of Spatial and Planar Paralell Robots, Multibody System Dynamic, vol. 27; pp. 239-265, 2012. [6] Do Sanh, On the Principle of Compatility and Equationof Motion of Constrained Mechanical Systems, ZAMM, Vol. 60, Berlin, pp.210-212, 1980. [7] Do Sanh, On the Motion of Controlled Mechanical Systems, Advances in Mechanics, Vol.2, Varsaw, pp.3-34. [8] Do Sanh, Chuyển động của các hệ chịu liên kết, Luận án Hình 5. Các liên kết chương trình f1, f2, và f3 Tiến sỹ Khoa hoc, ĐHBKHN, 1984. [9] Do Sanh, Do Dang Khoa, Method of Transnmission Matrix Applying for Investigation of Planar 3. Kết luận Mechanicsms, Machines Dynamics Research, Vol.14, N0 Trong bài báo đã đề xuất ý tưởng là sử dụng các chuỗi 4, pp.5-22, 2010, Varsaw, 2010. động để xử lý cho các robot song song, khi xem các robot [10] Sanh Do, Phong Dinh Van, Khoa Do Dang, Duc Tran, A song song là ghép nối tiếp và nối song song các chuỗi Method for Solving the Motion Equations of Constrained động. Trên cơ sở ý tưởng này sử dụng phương pháp ma Systems, 16th Asia Pacific Vibration Conference, Hanoi, trận truyền để giải quyết yêu cầu của bài toán. Đã xây Vietnam, 2015. dựng lộ trình giải quyết bài toán theo hai bước: [11] Đỗ Sanh, Đỗ Đăng Khoa, Động lực học giải tích, NXB 1. Khó khăn gặp phải khi khảo sát các rô bốt song song là Bách Khoa, Hà nội, 2017. ở chỗ chúng có cấu trúc phức tạp, không những là những [12] L-W Tsai, Robot analysis, The Mechanics of Serial and cơ cấu nhiều khâu nhiều khớp mà còn ở chỗ chúng được Parallel Manipulator, John Wiley & Sons, Inc., 1999. ghép từ nhiều chuỗi động. Trong bài báo qua một thí dụ cụ thể đã sử dụng phương pháp ma trân truyền khảo sát có kết quả động học một rô bốt có cấu trúc khá phức tạp. 2. Xây dựng lộ trình giải quyết bài toán động học ngươc không sử dụng phương pháp nhân tử (tránh được việc xác định các nhân tử), không sử dụng phương pháp “tách cấu trúc” (tránh việc phải xác định các nội lực). Do đó phương pháp này cho triển vọng khảo sát các rô bốt có cấu trúc phức tạp. 3. Các kết quả nhận được qua sử dụng phần mềm Maple cho thấy phương pháp đề xuất có độ tin cậy khả quan khi độ sai lệch của kết quả nhận được so với yêu cầu đặt ra là khá nhỏ. Tài liệu tham khảo [1] Nguyễn Văn Khang, Động lực học hệ nhiều vật, NXB Khoa học và Kỹ thuật, 2017. [2] Phan Bùi Khôi, Hà Thanh Hải, Hoàng Vĩnh Sinh, Điều khiển động lực học ngược robot tác hợp khi gia công phay, Tuyển tập công trình khoa học Hội nghị Cơ học Toàn quốc lần thứ 10, Hà nội, 08-09/12/2017, tr.352-361. [3] Phan Bùi Khôi, Nguyễn Xuân Hồng, Trần Đức Trung, Động lực học robot di động hai chân, Tuyển tập công