Robot SCARA ra đời vào năm 1979, đây là một kiểu tay máy có cấu tạo đặc biệt được sử dụng nhiều trong các công việc lắp ráp các tải trọng nhỏ theo phương thẳng đứng.
Tiểu luận môn học: Robot công nghiệp và người máy TRƯỜNG ĐẠI HỌC BÁCH KHOA TPHCM KHOA ĐIỆN-ĐIỆN TỬ BỘ MÔN ĐIỀU KHIỂN TỰ ĐỘNG -------- TIỂU LUẬN MÔN HỌC ROBOT CÔNG NGHIỆP VÀ NGƯỜI MÁY Đề tài: ĐIỀU KHIỂN ROBOT SCARA DÙNG MOMENT TÍNH Học viên: Nguyễn Minh Hồ Lớp: ĐKHKT K14 MSHV: 01503347 TPHCM 12/2004 Học viên: Nguyễn Minh Hoà Lớp: ĐKHKT K14 Trang 1 Tiểu luận môn học: Robot công nghiệp và người máy 1. Giới thiệu về Robot Scara Robot SCARA ra đời vào năm 1979, đây là một kiểu tay máy có cấu tạo đặc biệt được sử dụng nhiều trong các công việc lắp ráp các tải trọng nhỏ theo phương thẳng đứng. Robot SCARA bao gồm hai khớp nối và hai cánh tay. Trên hai khớp nối sẽ gắn hai động cơ để cung cấp moment 21 , ττ điều khiển hai cánh tay l 1 ,l 2 như hình vẽ. 1 θ 2 θ 1 l 2 l Hình 1: Hình chiếu bằng Robot Scara 2. Mô hình động học của Robot SCARA Phương trình động học của Robot SCARA như sau: )1(),()( τ =+ qqqCqqM Trong đó 21 ,qq là góc quay của hai trục động cơ DC và 21 , θθ là góc quay của hai khớp xoay của robot. Trong đó: +++− +−+ = 2 2322121 2121 2 11 ))(cos( ))(cos( )( mlIIqqklml qqklmlmlI qM e e + + = 2 . 12121 . 221211 . ))(sin( ))(sin( ),( Vqqqkklml qqqkklmlV qqC ee ee Quan hệ giữa [ ] 21 qq và [ ] 21 θθ như sau: )2( 0 2 1 2 1 − = q q kk k ee e θ θ Các thông số được cho như sau: Học viên: Nguyễn Minh Hoà Lớp: ĐKHKT K14 Trang 2 Tiểu luận môn học: Robot công nghiệp và người máy 2 1 .8.1 mKgI = : Moment quán tính của cánh tay 1 2 2 .041.0 mKgI = : Moment quán tính của cánh tay 2 2 3 .134.0 mKgI = : Moment quán tính của tải trọng Kgm 10 = : Khối lượng tải ml 4.0 1 = : Chiều dài của cánh tay 1 ml 35.0 2 = : Chiều dài của cánh tay 2 5.0 = e k : Hệ số truyền động của khớp nối 2 smKgV /.5 2 1 = : Hệ số ma sát của khớp nối 1 smKgV /.3 2 2 = : Hệ số ma sát của khớp nối 2 Tín hiệu vào: Moment 21 , ττ của 2 động cơ DC(hoặc điện áp) Tín hiệu ra: Góc 21 , θθ của 2 cánh tay robot SCARA. 3. Hệ phương trình biến trạng thái mô tả robot Biến đổi phương trình (1) và (2) ta được: [ ] 22 2 2 1 22 232 2 11 2211 2 232 2 . 221 . 11 2 232 2 2 21 2 232 2 1 2 2 2 1 2 1 ))(( )( )()( AllmmlIImlI AlmlmlII qAVlmlqVmlIIqBklmlmlIIqABkllm q ee −+++ +++ +−++−++−− = ττ [ ] 22 2 2 1 22 232 2 11 2 2 11121 2 . 2 2 11 1 . 121 2 2 2 2 2 1 2 2 1 21 2 11 2 ))(( )( )()( AllmmlIImlI mlIAlml qVmlIqAVlmlqABllmqBklmlmlI q e −+++ ++ ++−−−+− = ττ (3) Với ))(sin())(cos( 2121 qqkBqqkA ee +=+= Đặt các biến trạng thái như sau: Học viên: Nguyễn Minh Hoà Lớp: ĐKHKT K14 Trang 3 Tiểu luận môn học: Robot công nghiệp và người máy 2 . 4 3 . 23 1 . 2 1 . 11 )4( qxx qx qxx qx == = == = Từ (3) và (4) ta được hệ phương trình biến trạng thái mô tả robot sau: [ ] [ ] 22 2 2 1 22 232 2 11 2 2 11121 42 2 112121 2 4 2 2 2 1 22 221 2 11 4 . 4 3 . 22 2 2 1 22 232 2 11 2211 2 232 422121 2 232 2 421 2 232 2 2 2 2 2 1 2 2 . 2 1 . ))(( )( )()( )5( ))(( )( )()( AllmmlIImlI mlIAlml xVmlIAxVlmlABxllmBxklmlmlI x xx AllmmlIImlI AlmlmlII AxVlmlxVmlIIBxklmlmlIIABxkllm x xx e ee −+++ ++ ++−−−+− = = −+++ +++ +−++−++−− = = ττ ττ 4. Quỹ đạo đầu mút cánh tay Robot SCARA Mối liên hệ giữa các khớp nối 1 và 2 có toạ độ góc [ ] T qq 21 với các cánh tay có tọa độ góc [ ] T 21 θθ , được mô tả bởi phương trình (2) − = 2 1 2 1 0 q q kk k ee e θ θ Tọa độ đầu mút của cánh tay robot SCARA được xác định bởi phương trình sau: )6()sin(sin )cos(cos 21211 21211 θθθ θθθ ++= ++= lly llx Học viên: Nguyễn Minh Hoà Lớp: ĐKHKT K14 Trang 4 Tiểu luận mơn học: Robot cơng nghiệp và người máy Các phương trình trên áp dụng cho bài tốn điều khiển theo khơng gian khớp nối. Cho phép xác định cặp góc [ ] T 21 θθ từ tọa độ (x,y) cho trước của đầu mút cánh tay robot SCARA trong khơng gian hoạt động. Trong q trình điều khiển robot, ứng với một vị trí (x,y) trong khơng gian hoạt động có thể có nhiều cặp góc trong khơng gian khớp nối. Do đó, ta phải chọn lựa một cặp nghiệm phù hợp với u cầu điều khiển. Có nhiều cách chọn lựa tuỳ theo đối tượng và mục đích: - Tổng qng đường dịch chuyển của các khớp ngắn nhất. - Giảm bớt ảnh hưởng tương tác giữa các khớp. - Năng lượng tiêu thụ thấp nhất. - Giới hạn động học của hệ thống. Robot SCARA với hai khớp nối ứng với mỗi tọa độ (x,y) của đầu mút cánh tay chúng ta sẽ có hai nghiệm cho các cặp góc. Do đó, ta sẽ chọn cặp góc sao cho tổng biến thiên của cặp góc từ vị trí k-1 đến vị trí k là nhỏ nhất. ( ) )7()1()()1()(min 2211 −−+−− kkkk θθθθ Giới hạn khơng gian hoạt động của hệ thống thơng qua cặp góc [ ] T qq 21 )8( 2 1 πθπ πθπ ≤≤− ≤≤− 5. Điều khiển robot SCARA dùng moment tính(computed torque) Trong phương pháp moment tính, ta phải xây dựng hai vòng điều khiển. Vòng hồi tiếp trong được xây dựng dựa trên động lực học của hệ thống để bù tất cả các thành phần phi tuyến của hệ thống. Vòng hồi tiếp ngồi xây dựng dựa trên sai lệch giữa tín hiệu ra và tín hiệu đặt. Chức năng của vòng hồi tiếp trong là tuyến tính hố mối liên hệ giữa tín hiệu đặt và tín hiệu ra trong khi vòng hồi tiếp ngồi làm ổn định hố hệ thống. 5.1 Cấu trúc của bộ điều khiển moment tính Bộ điều khiển PD Chiến lược điều khiển Hồi tiếp tuyến tính hoá SCARA ROBOT Hệ thống tuyến tính hoá Vòng điều khiển trong Vòng điều khiển ngoài Hình 2: Sơ đồ hệ thống điều khiển dùng moment tính 5.1.1 Hồi tiếp tuyến tính hố Mơ hình robot SCARA được cho bởi (1) như sau: τ =+ ),()( qqqCqqM Học viên: Nguyễn Minh Hồ Lớp: ĐKHKT K14 Trang 5 Tiểu luận môn học: Robot công nghiệp và người máy Với +++− +−+ = 2 2322121 2121 2 11 ))(cos( ))(cos( )( mlIIqqklml qqklmlmlI qM e e + + = 2 . 12121 . 221211 . ))(sin( ))(sin( ),( Vqqqkklml qqqkklmlV qqC ee ee Để tuyến tính hố và phân ly, ta chọn luật điều khiển τ gồm hai thành phần như sau: )9( NL τττ += Với )11( )10( . qM qCqM dL nN = += τ τ SCARA ROBOT ),( . qqN + + N τ L τ q Hình 3: Sơ đồ cấu trúc hồi tiếp tuyến tính hố +− +− = 0))(cos( ))(cos(0 2121 2121 qqklml qqklml M e e n ++ + = 2 231 2 11 0 0 mlII mlI M d + + = 2 . 12121 . 221211 . ))(sin( ))(sin( ),( Vqqqkklml qqqkklmlV qqC ee ee 5.1.2 Điều khiển PD Đặt qy = với y là tín hiệu vào mới, ta có luật điều khiển được mô tả như sau: )12(yM dL = τ Mục đích điều khiển là tín hiệu ra )(tq bám theo quỹ đạo thiết kế )(tq d Ta có: )13( . d ddp d qKqKqr ++= Chọn luật điều khiển )14( . rqKqKy dp +−−= Học viên: Nguyễn Minh Hoà Lớp: ĐKHKT K14 Trang 6 Tiểu luận mơn học: Robot cơng nghiệp và người máy Thay (13) vào (14) ta được qqe KeKe d pd −= ++ )15( . Giả thuyết Kp và Kd là các ma trận dương xác định, ổn định tiệm cận Từ (10) và (11) ta được ++− ++− = 2 1 21 2 . 2 1 21 2 2 21 1 . 1 2 21 2 1 qBklmlqVqAlml qBklmlqVqAlml e e N N τ τ ))(sin())(cos( 2121 qqkBqqkA ee +=+= ++++ +++ = ))(( ))(( 2 . 2 2 2 232 1 . 1 1 2 11 2 1 eKeKqmlII eKeKqmlI pd d pd d L L τ τ . qqe qqe d d −= −= PD Chiến lược điều khiển SCARA ROBOT ),( . qqN + + N τ L τ q Hình 4: Sơ đồ khối hệ thống điều khiển dùng moment tính 5.2 Thực hiện mơ phỏng hệ thống điều khiển robot SCARA dùng moment tính 5.2.1 Xây dựng sơ đồ mơ phỏng Xây dựng mơ hình robot SCARA theo phương trình (1) trên Simulink như sau: Học viên: Nguyễn Minh Hồ Lớp: ĐKHKT K14 Trang 7 Tiểu luận môn học: Robot công nghiệp và người máy Hình 5: Mô hình robot SCARA Hình 6: Sơ đồ điều khiển dùng moment tính Học viên: Nguyễn Minh Hoà Lớp: ĐKHKT K14 Trang 8 Tiểu luận môn học: Robot công nghiệp và người máy Hình 7: Sơ đồ khối phần hồi tiếp tuyến tính hố Hình 8: Sơ đồ khối bộ điều khiển PD 5.2.2 Kết quả mô phỏng 5.2.2.1 Đáp ứng bước: Học viên: Nguyễn Minh Hoà Lớp: ĐKHKT K14 Trang 9 Tiểu luận môn học: Robot công nghiệp và người máy 0 20 40 60 0 0.2 0.4 0.6 0.8 1 Tin hieu qd1-q1 0 20 40 60 0 0.2 0.4 0.6 0.8 1 Tin hieu qd2-q2 Hình 9: Đáp ứng bước của q1 và q2 Hình 10: Moment của 2 động cơ khi tín hiệu vào là hàm bước Nhận xét: Đáp ứng bước không có vọt lố, loại bỏ được sự ảnh hưởng lẩn nhau giữa hai khớp nối 5.2.2.2 Bám theo quỹ đạo hình sin: Học viên: Nguyễn Minh Hoà Lớp: ĐKHKT K14 Trang 10 [...]...Tiểu luận môn học: Robot công nghiệp và người máy q1 qd1 q2 qd2 qd1-q1 qd2-q2 1 1 0.5 0.5 0 0 -0.5 -0.5 -1 -1 0 10 20 0 5 10 Hình 11: Đáp ứng ngõ ra q1 và q2 khi tín hiệu vào là hình sin Hình 12: Moment của 2 động cơ DC 1 và DC2 khi tín hiệu vào là sin Nhận xét: Ngỏ ra của hệ thống bám theo tín hiệu vào hình... ra của hệ thống bám theo tín hiệu vào hình sin rất tốt,gần như không có sai số,hệ phân ly tốt các khớp không bị ảnh hưởng lẩn nhau Học viên: Nguyễn Minh Hoà Lớp: ĐKHKT K14 Trang 11 Tiểu luận môn học: Robot công nghiệp và người máy Học viên: Nguyễn Minh Hoà Lớp: ĐKHKT K14 Trang 12 . t nh hoá V ng i u khi n trong V ng i u khi n ngo i H nh 2: Sơ đồ hệ th ng i u khi n d ng moment t nh 5.1.1 H i tiếp tuy n t nh hố Mơ h nh robot SCARA được. 5. i u khi n robot SCARA d ng moment t nh( computed torque) Trong phư ng pháp moment t nh, ta ph i xây d ng hai v ng i u khi n. V ng h i tiếp trong được