NGHIÊN C ỨU XÂY DỰNG HỆ PHƯƠNG TRÌNH XÁC ĐỊNH CHUYỂN VỊ ĐÀN HỒI CỦA TAY MÁY CÔNG NGHIỆP BẰNG PHƯƠNG PHÁP PHẦN TỬ H ỮU HẠN RESEACH ON BUILDING DEFORMATIONS ELASTIC EQUATIONS OF INDUSTR
Trang 1NGHIÊN C ỨU XÂY DỰNG HỆ PHƯƠNG TRÌNH XÁC ĐỊNH CHUYỂN VỊ ĐÀN HỒI CỦA TAY MÁY CÔNG NGHIỆP BẰNG PHƯƠNG PHÁP PHẦN TỬ
H ỮU HẠN
RESEACH ON BUILDING DEFORMATIONS ELASTIC EQUATIONS OF
INDUSTRIAL MANIPULATOR BASE ON FINITE ELEMENT METHOD
Biên Dương Xuân 1 , M ỳ Chu Anh 1 , Dũng Nguyễn Trí 2
1 Học viện Kỹ thuật Quân sự, Hà Nội, Việt Nam
2Trường Đại học Công nghiệp Hà Nội
xuanbien82@yahoo.com
TÓM T ẮT
Khi giải quyết các bài toán cơ học và điều khiển robot, các nhà thiết kế vẫn coi các khâu
là rắn tuyệt đối và coi chuyển vị đàn hồi (CVDH) của các thành phần trong hệ thống là nhỏ, ảnh hưởng ít đến độ chính xác hoạt động của robot Tuy nhiên, việc nghiên cứu ảnh hưởng
của chuyển vị đàn hồi sẽ giúp cho hoạt động của tay máy chính xác hơn, thực tế hơn Bài báo
tập trung trình bày việc xây dựng hệ phương trình chuyển vị đàn hồi và tính toán CVDH cho
hệ tay máy 2 khâu phẳng bằng phương pháp phần tử hữu hạn (PTHH) Kết quả của bài báo có
thể làm cơ sở phát triển hệ điều khiển tương ứng nhằm nâng cao độ chính xác định vị của hệ tay máy 2 khâu phẳng nói riêng và hệ tay máy chuỗi hở nói chung khi có kể đến ảnh hưởng
của chuyển vị đàn hồi trong các khâu
Từ khóa: robot công nghiệp, chuyển vị đàn hồi, tay máy 2 khâu phẳng
ABSTRACT
Designers has considered links of robot are rigid bodies when they solve problems about mechanic and control robot They considered that deformations elastic of links are small and don’t effect on accuracy of industrial robot However, the study on influence of deformations elastic will help actions of robot are more accuracy and reality This paper focus on building deformations elastic equations and calculation for two-link planar manipulator base on finite element method The results can be used to improve corresponding control system to advances positioning accuracy of two-link planar manipulator and other open serial manipulators
Keywords: industrials robot, deformation elastic, two-link planar manipulator
1 ĐẶT VẤN ĐỀ
Khi nghiên cứu về tay máy công nghiệp, chúng ta cần giải quyết nhiều bài toán như: động học, động lực học, điều khiển và một số vấn đề khác (dư dẫn động, kì dị, độ bền cơ cấu,
khả năng tải, độ linh hoạt,…) Vấn đề đặt ra là đa số các công trình công bố trong và ngoài nước đều lấy giả thuyết các khâu của robot là rắn tuyệt đối, mô hình động lực là lý tưởng, ứng
xử động lực xuyên suốt, liên tục theo thời gian và nội tại hệ không tồn tại biến dạng, chuyển
vị đàn hồi Sai số sinh ra trong quá trình chuyển động đều được bù và hiệu chỉnh trong chương trình điều khiển [5, 6, 7, 8] Việc này dẫn đến sự phức tạp trong điều khiển và mô hình chưa sát với thực tế
Vấn đề ảnh hưởng của chuyển vị đàn hồi đến độ chính xác định vị của robot được xem xét trên thế giới với nhiều góc cạnh khác nhau Một số công trình mặc định chấp nhận chuyển
vị đàn hồi, tìm cách đo đạc sai số định vị trên thực tế bằng các phương pháp khác nhau và đề
xuất phương án bù sai số bằng điều khiển phản hồi tuyến tính hoặc phi tuyến [5, 6, 7, 8, 9] Công trình [10] có liệt kê một số kỹ thuật được sử dụng để xét đến chuyển vị đàn hồi của robot và kết quả bài báo chỉ ra phương pháp phần tử hữu hạn là phù hợp hơn cả Tài liệu [11]
Trang 2đề cập đến hai giải pháp hiệu chỉnh robot để giảm bớt sai số do chuyển vị đàn hồi Thứ nhất là đơn giản hóa mô hình bằng cách thiết kế giảm chiều dài khâu, thêm vào các khâu kín song song, tăng diện tích mặt cắt hoặc giảm tỷ số truyền của động cơ truyền động Điển hình là Robot KUKA 500-2 MT hay ABB IR7600-500 Tuy nhiên, các robot này rất đắt và kém linh
hoạt Cách thứ 2 tác giả đề xuất là can thiệp vào phần điều khiển bằng cách sử dụng luật mờ (Takagi Sugeno Fuzzy) để hiệu chỉnh robot Dữ liệu đầu vào có được khi coi mô hình robot là
hệ gồm các khâu cứng liên kết với nhau thông qua các lò xo đại diện cho yếu tố chuyển vị đàn
hồi của các khớp và các khâu Tuy nhiên, độ chính xác của phương pháp phụ thuộc nhiều vào
số lượng, kích cỡ và vị trí của các lò xo Phương pháp này cũng được đề cập trong các tài liệu [12,13] Ngoài ra, tác giả cũng nhắc đến phương pháp ứng dụng mô đun CAE trong các phần
mềm thiết kế CAD/CAM để tính toán chuyển vị Tuy nhiên, phương pháp này có nhược điểm
lớn là thời gian tính toán lâu không phù hợp với điều khiển robot trong thời gian thực [14]
Một số trường hợp, cơ hệ có cấu trúc không gian nhẹ (khâu đàn hồi-flexible links) và hoạt động với tốc độ cao thì việc xem xét ảnh hưởng của chuyển vị đàn hồi đóng một vai trò vô cùng quan trọng trong hoạt động của cơ hệ [15,16] Nó tác động trực tiếp tới độ chính xác trong hoạt động
Như vậy, vấn đề đặt ra là nếu ta xây dựng thêm được hệ phương trình xác định chuyển
vị đàn hồi của các khâu thì kết quả của nó cho phép thiết lập hệ điều khiển tương ứng chính xác hơn, thực tế hơn do đầu vào đã kể đến ảnh hưởng của chuyển vị đàn hồi
2 NỘI DUNG NGHIÊN CỨU
2.1 H ệ phương trình động lực học tay máy
Xét mô hình robot phẳng hai khâu [1] như Hình 1:
Hình 1 Mô hình robot ph ẳng hai khâu
Trong đó: Ox0y z O y z O0 0, x1 1 1, x2y z l2 2 ần lượt là hệ tọa độ cố định, hệ tọa độ địa phương
gắn với khớp 1 (tại O) và khớp 2 (tại A); q q m m l l C C1, 2, 1, 2, , ,1 2 1, 2: biến khớp, khối lượng, chiều dài khâu và vị trí trọng tâm khâu 1, khâu 2 P P x, y: ngoại lực tác dụng tại điểm thao tác
cuối B τ τ1, 2: mô men truyền động tại các khớp 1 và 2 Gọi khoảng cách OC1 l C1,
2 C2
AC l ; Véc tơ biến khớp q=[q q1 , 2]T Ta có bảng tham số động học D-H và động lực học như Bảng 1 và Bảng 2
B ảng 1 Bảng tham số động học D-H
Trang 3B ảng 2 Tham số động lực học các khâu
Khâu Vị trí trọng tâm Khối
lượng
Ma trận mômen quán tính I
Ta có tọa độ điểm thao tác cuối theo hệ tọa độ cố định:
B
B
= + + (1)
Tọa độ trọng tâm các khâu theo hệ tọa độ cố định:
cos sin 0
C
C C
0
C
Tiến hành tính toán các ma trận Jacobi tịnh tiến J T1,J , ma tr T2 ận Jacobi quay J R1,J R2,
thế năng trọng lực g1( ),q g2( )q cho các khâu, ma trận khối lượng suy rộng M( )q , biểu thức
động năng T, thế năng Π, ngoại lực tác dụng vào hệ và áp dụng hệ phương trình vi phân
Lagrange loại II:
*
i
Q
Ta có hệ phương trình vi phân động lực học của hệ:
2
2 1 2 2 1 2 2 1 2 2 2 1 1 2 1 1 2 2 1 2
2
τ
τ
=
2 2 1 2 2 2 1 2 2 2 2 2 1 2 1 2
(4)
Dễ nhận thấy rằng, các thành phần cấu thành hệ phương trình vi phân động lực học
chưa kể đến ảnh hưởng của chuyển vị đàn hồi Khi sử dụng hệ phương trình (4) trong giải bài
toán điều khiển sẽ xuất hiện sai số Nếu ta xây dựng thêm hệ phương trình xác định chuyển vị
đàn hồi theo các giá trị biến khớp và có kể đến các yếu tố nội tại của các khâu như mô đun
đàn hồi (đặc trưng cho biến dạng của vật thể khi chịu tác động của ngoại lực), khối lượng
riêng (đặc trưng cho mật độ của vật chất) để đưa thêm dữ liệu cho bài toán điều khiển thì hoàn
toàn có thể làm giảm bớt sai số định vị khi tay máy hoạt động
2.2 Xây d ựng hệ phương trình xác định chuyển vị đàn hồi
Để xác định chuyển vị của các phần tử, ta có thể sử dụng một số phương pháp khác
nhau như phương pháp lực, phương pháp chuyển vị và phương pháp phần tử hữu hạn (PTHH)
[4] Với sự phát triển không ngừng của ngành công nghệ thông tin thì ngày nay giải các bài
toán PTHH trở nên dễ dàng Đây là phương pháp phù hợp để xác định chuyển vị trên tay máy
công nghiệp Trong nội dung bài báo này, tác giả tập trung vào phương pháp PTHH mô hình
chuyển vị, ẩn số là các chuyển vị nút cho hệ tay máy 2 khâu phẳng
Trang 4Rời rạc hóa kết cấu tay máy 2 khâu phẳng thành 2 phần tử liên kết với nhau và với đất
tại các nút O O E1 , 2 ,
Hình 2 Mô hình các ph ần tử của tay máy 2 khâu phẳng
Trong đó: Ox0y z O y z O0 0, x1 1 1, x2y z O2 2, x3y z l3 3 ần lượt là hệ tọa độ cố định và các hệ tọa
độ địa phương gắn với nút O O E1 , 2 , ; { } {d = d d d d d d d d d1, 2, 3, 4, 5, 6, 7, 8, 9},
{ } {R = R R R R R R R R R1, 2, 3, 4, 5, 6, 7, 8, 9} là véc tơ chuyển vị đàn hồi tại các nút O O E1 , 2 , (chuyển
vị nút) và lực nút ứng với các hệ tọa độ địa phương (d1, d4, d7) là chuyển vị dọc trục dầm (theo trục x) (d2, d5, d8) là chuyển vị theo trục y và (d3, d6, d9) là chuyển vị thẳng theo trục
z E l J, ,1 1,ρ1, ,l J2 2,ρ2 lần lượt là mô đun đàn hồi, chiều dài, mô men quán tính và khối lượng riêng các khâu, biến khớp q=[q q1 , 2]T Gọi { } {' ' ' ' ' ' ' ' ' '}
1, 2, 3, 4, 5, 6, 7, 8, 9
d = d d d d d d d d d , { } {' ' ' ' ' ' ' ' ' '}
1, 2, 3, 4, 5, 6, 7, 8, 9
R = R R R R R R R R R là véc tơ chuyển vị nút và véc tơ tải trọng nút gắn với
hệ tọa độ cố định Ox y z Vi0 0 0 ệc chuyển đổi giữa các hệ tọa độ được thực hiện qua công thức:
{ } [ ] { }'
i i i
d = T d hay { }' [ ] 1{ } [ ]T{ }
d = T − d = T d (5) Trong đó: [ ]T là ma tr i ận chuyển đổi hệ tọa độ và trực giao [2] nên [ ] [ ]1 T
i i
T − = T
T
−
−
(6)
Hệ phương trình cân bằng của hệ trong hệ cố định theo lý thuyết PTHH:
{ }' ' { }'
Trong đó: '
K
là ma trận độ cứng của hệ trong hệ tọa độ cố định Đưa vào các điều
kiện biên tại nút O1 nối đất thì phương trình cân bằng có dạng mới [2]:
{ }* * { }*
Trang 5Tại nút O1 có thể coi là liên kết dạng ngàm nên ' ' '
d =d =d = Do vậy, véc tơ chuyển
vị nút cần tìm là: { } {* * * * * * *}
4 , 5 , 6 , 7 , 8 , 9
* Xác định ma trận độ cứng
Ma trận độ cứng trong hệ tọa độ địa phương theo [2]:
[ ]
−
−
−
−
−
−
−
=
l
EJ l
EJ l
EJ l
EJ l
EJ l
EJ l
EJ
l
EF l
EF
l
EJ l
EJ l
EJ l
EJ l
EJ l
EJ l
EF l
EF
K i
4 6
0 2
6 0
6 12
0 6
12 0
0 0
0 0
2 6
0 4
6 0
6 12 0
6 12
0
0 0
0 0
2 2
2 3
2 3
2 2
2 3
2 3
(9)
Áp dụng công thức chuyển đổi hệ tọa độ: [ ] [ ] [ ] [ ]' T
K = T K T , ta có kết quả như sau:
'
i i i i i i i i i i i i i i i i i i i i i i i i
i i i i i i i i i i i i i i i i i i i i i i i i
i
i i i i i i
D Sq N Cq D Sq Cq N Sq Cq C Sq D Sq N Cq D Sq Cq N Sq Cq C Sq
D Sq Cq N Sq Cq D Cq N Sq C Cq D Sq Cq N Sq Cq D Cq N Sq C Cq
K
D Sq N Cq D Sq C
=
i i i i i i i i i i i i i i i i i i
i i i i i i i i i i i i i i i i i i i i i i i i
q N Sq Cq C Sq D Sq N Cq D Sq Cq N Sq Cq C Sq
D Sq Cq N Sq Cq D Cq N Sq C Cq D Sq Cq N Sq Cq D Cq N Sq C Cq
−
(10)
Mô đun đàn hồi của vật liệu khâu (coi các khâu có cùng thành phần vật liệu); J : Mô men i
quán tính của các khâu; F : ti i ết diện từng khâu Căn cứ theo (10) ta dễ dàng xác định được
'
1
K
2
K
và ta kí hiệu các phần tử của chúng như công thức (11) dưới đây:
(11)
Trang 6Ma trận độ cứng toàn hệ [ ]K có dạng ma trận vuông 9x9 ứng với các chuyển vị nút Tuy nhiên, khi xét đến điều kiện biên ta có thể loại bỏ hàng thứ j và cột thứ j tương ứng với chuyển vị nút {q}j = Suy ra ma trận toàn hệ suy biến về dạng: 0
*
* 77
K K
K
(12)
Theo [2], các phần tử *
,
j k
K
(các chỉ số ,jk được lấy theo chỉ số cột dọc và
ngang bên ngoài của các ma trận của ma trận '
1
K
và K2' trong (11)) được tính như sau:
2
1
i
j k j k i
=
=∑ (13)
Cụ thể
* '(1) '(2) * '(1) '(2) * '(1) '(2) * '(2) * '(2) * '(2)
44 44 44 ; 55 55 55 ; 66 66 66 ; 77 77 ; 88 88 ; 99 99
Tương tự, ta có thể tính được các phần tử khác của *
K
* Xác định véc tơ tải trọng quy nút { }*
R
Lấy giả thiết vật liệu trên các khâu có tính liên tục và đẳng hướng nên có thể coi là phân
bố đều về mặt khối lượng Gọi lực phân bố do khối lượng khâu gây ra là (p kN cm Mô / ) hình tính tải nút có thể xét như Hình 3
Hình 3 Mô hình tính l ực nút với tải trọng phân bố
Để tính { }*
R cần tính được { } { }'
,
i i
R R Gọi x là giá trị biến chiều dài có giới hạn
0≤ ≤ Do ta xét tay máy 2 khâu phẳng nên có thể coi tải xoắn x l τ( )x =0 và tải phân bố đều
p = =p c Ta có:
2
5 5( ) ( ) 6 6( ) ( )
0
2
12
i
l
τ
τ
0
i
l
(14)
Trong đó H1( )x ;H2( )x ;H3( )x ;H4( )x ;H5( )x ;H6( )x là các hàm dạng của các phần tử [2]
Trang 7Lúc này:
'( )
1 '( )
2 '( )
3
'( )
'( )
'( )
i i i
i
i i
T
R
R
R R
−
−
(15)
Cụ thể:
(16)
Mỗi phần tử của véc tơ { }*
R được xác định:
2
1
i
i
=
=∑ (17)
Chỉ số j lấy theo cột chỉ số bên cạnh phải tương ứng mỗi véc tơ lực nút Cụ thể:
* '(1) '(2) * '(1) '(2) * '(1) '(2) * '(2) * '(2) * '(2)
Vậy ta có:
T
R = R R R R R R (18) Thay (12) và (18) vào (8) ta có thể tính được chuyển vị nút:
d = K − R (19)
2.3 Mô ph ỏng kết quả tính toán chuyển vị đàn hồi
Áp dụng tính toán chuyển vị cho mô hình tay máy 2 khâu phẳng (Hình 2) với các tham
số cụ thể như Bảng 3
B ảng 3 Giá trị các tham số của tay máy 2 khâu phẳng
Khâu
Mô đun
đàn hồi E
(Kg/cm2)
Khối lượng riêng ρ (Kg/cm3)
Tải tập trung
Px (N)
Tải tập trung
Py (N)
Bề
rộng khâu B (cm)
Bề ngang khâu H(cm)
Chiều dài khâu (cm)
Biến khớp (rad)
0
3
t π
≤ ≤
π +
Trang 8Sử dụng phần mềm Maple và Matlab để tính toán các ma trận độ cứng, tải trọng nút và chuyển vị nút, ta có các kết quả như sau:
* Xét v ị trí tay máy với các giá trị cố định: 1 ; 2 0
6
Dễ thấy, chuyển vị tại nút O2 lần lượt theo các trục X, Y, Z là: 0.012 mm, 0.02 mm, -0.0018 mm; tại nút E (điểm thao tác cuối): 0.012 mm, -0.04 mm, -0.0019 mm Các giá trị này
rất nhỏ và giá trị có dấu (-) thể hiện ngược chiều so với chiều trục ứng với các nút Vì xét tay máy phẳng nên ta chưa xét đến chuyển vị theo chiều trục Z Các giá trị chuyển vị này có thể
sẽ lớn nếu chịu thêm các ngoại lực tác dụng (tải trọng bên ngoài) Lúc này, vị trí điểm thao tác
cuối được mô tả như Bảng 4
Bảng 4 Tọa độ điểm thao tác cuối
Tọa độ điểm thao tác cuối (E) X E(mm) Y mm E( )
Khi chưa kể đến chuyển vị đàn hồi 150 3 150
Khi đã kể đến chuyển vị đàn hồi 150 3 + 0.012 150 0.04 −
* Xét v ị trí tay máy với các biến khớp thay đổi theo thời gian t(s):
q =π +t q =t ≤ ≤t π
Với các giá trị biến khớp thay đổi, ta có thể so sánh quỹ đạo chuyển động (1) trong hai trường hợp là chưa kể đến chuyển vị đàn hồi và có kể đến chuyển vị đàn hồi như Hình 4
Hình 4 T ọa độ điểm thao tác cuối ở hai trường hợp
Đồ thị Hình 4 cho ta thấy sự sai lệch vị trí của điểm thao tác cuối khi có kể đến ảnh hưởng của CVDH Do giá trị chuyển vị là rất nhỏ nên khó nhận ra sai lệch trên Hình 4, ta có
thể mô tả sai lệch theo Hình 5
Trang 9Hình 5 Giá tr ị chuyển vị đàn hồi theo trục X và Y tại nút E
Về bản chất, đây chính là giá trị chuyển vị đàn hồi theo chiều X và Y ứng với hệ tọa độ địa phương tại nút E Để điều khiển được tay máy đúng theo quỹ đạo mong muốn thì cần phải xác định quy luật biến khớp (bài toán động học ngược) và tính toán mô men điều khiển các
khớp (bài toán động lực học) Tuy nhiên, do có ảnh hưởng của chuyển vị đàn hồi, với các giá
trị mô men tính toán cũ thì quỹ đạo chuyển động sẽ có sai lệch không như mong muốn và cần
phải bù các sai lệch này Như vậy, đầu vào của hệ điều khiển ngoài hệ phương trình động lực
học (11) còn có thêm hệ phương trình xác định chuyển vị đàn hồi (26) tại các nút nhằm điều khiển tay máy hoạt động chính xác hơn
3 K ẾT LUẬN
Bài báo đã trình bày cơ bản về việc xây dựng hệ phương trình vi phân động lực học theo phương trình Lagrange loại II và hệ phương trình tính chuyển vị đàn hồi tại các nút của các
phần tử theo phương pháp phần tử hữu hạn cho hệ tay máy 2 khâu phẳng Bài báo cũng thể
hiện tính toán cụ thể chuyển vị nút của các phần tử tại một vị trí cố định và trong khoảng giá
trị biến khớp thay đổi nhằm so sánh, đánh giá sai lệch vị trí điểm thao tác cuối khi có kể đến ảnh hưởng của chuyển vị đàn hồi và làm cơ sở xây dựng các thông số đầu vào khi thiết lập hệ điều khiển sau này
TÀI LIỆU THAM KHẢO
[1] Nguyễn Văn Khang, Chu Anh Mỳ, Cơ sở robot công nghiệp, Nhà xuất bản Giáo dục,
2010
[2] Vũ Khắc Bảy, Bài giảng phương pháp số (phương pháp phần tử hữu hạn), Bộ môn
Toán, Đại học Lâm nghiệp, 2012
[3] Trần Ích Thịnh, Ngô Như Khoa, Phương pháp phần tử hữu hạn, Đại học Kỹ thuật Công
nghiệp - Đại học Thái Nguyên, 2007
[4] Nguyễn Công Trí, Nguyễn Thị Hiền Lương, Tính toán khung phẳng bằng phương pháp
ph ần tử rời rạc biến thể sử dụng mô hình chuyển vị, Tạp chí KH&PT công nghệ, 2006
[5] Wisama Khalil, Philippe Lemoine, Autonomous calibration of robot using planar
points, International Symposium on Robotics and Manufacturing, Montpellier, France,
2009
[6] A Watanabe, S Sakakibara, A kinematic calibration method for industrial robots using
autonomous visual measurement, Annals of the CIRP vol 55/1/2006
[7] Ali Nahvi, John M Hollerbach, Cablration of a parallel robot using multiple kinematics
closed loops, IEEE 1994
Trang 10[8] Andrew B Lintott, Geometric modeling and accuracy enhancement of parallel
manipulators, University of Canterbury Christchurch New Zealand, 2000
[9] In-chul Ha, Kinematic parameter calibration method for industrial robot manipulator
using the relative position, Journal of mechanical science and technology, 2008
[10] Mathieu Rognant, A systematic proceduce for the elasto-dynamic modeling and
identification of robot manipulator, IEEE Transaction on Robotics 1085-1093, 2010
[11] Stephane Marie, Eric Courteille, Patrick Maurine, Elasto – Geometrical modeling and
calibration of robot manipulator: Application to machining and forming applications,
Mechanism and Machine theory 69, P 13-43 2013
[12] Ivan J Baiges–Valentin, Dynamic modeling of parallel manipulators, University of
Florida, 1996
[13] Claire Dumas, Stephane Caro, Joint stiffness identification of industrial serial robot,
Robotica, Cambridge University, 2011
[14] T T Mon, F R Mohd Romlay, Role of Finite Element Analysis in designing multi-axes
positioning for Robotic Manipulators, Advances in Robot manipulators, Malaysia,
2010
[15] D Wang and M Vidyasagar, Transfer functions for a single flexible link, Proceeding of
the 28th IEEE conference on Decision and Control,1989
[16] G Hastings and W Book, Verification of a linear dynamic model for flexible robotic
manipulators, Proceedings IEEE International Conference on Robotics and
Automation.Vol 3, P 1024 – 1029, 1986
THÔNG TIN TÁC GI Ả
Dương Xuân Biên
Email: xuanbien82@yahoo.com, ĐT: 01667193567