Thiết kế bộ điều khiển phi tuyến cho robot hàn di động

BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC CÔNG NGHỆ TP HCM - THÂN VĂN THẾ THIẾT KẾ BỘ ĐIỀU KHIỂN PHI TUYẾN CHO ROBOT HÀN DI ĐỘNG LUẬN VĂN THẠC SĨ Chuyên ngành : Kỹ thuật điện tử Mã số ngành: 60520114 TP HỒ CHÍ MINH, tháng 02 năm 2014 BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC CÔNG NGHỆ TP HCM - THÂN VĂN THẾ THIẾT KẾ BỘ ĐIỀU KHIỂN PHI TUYẾN CHO ROBOT HÀN DI ĐỘNG LUẬN VĂN THẠC SĨ Chuyên ngành : Kỹ thuật điện tử Mã số ngành: 60520114 CÁN BỘ HƯỚNG DẪN KHOA HỌC: TS NGUYỄN HÙNG TP HỒ CHÍ MINH, tháng 02 năm 2014 BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐH CÔNG NGHỆ TP HCM CỘNG HÒA XÃ HỘI CHỦ NGHĨA VIỆT NAM Độc lập – Tự – Hạnh phúc NHẬN XÉT LUẬN VĂN THẠC SĨ (Nhận xét CB hướng dẫn ) Họ tên học viên: THÂN VĂN THẾ Đề tài luận văn: THIẾT KẾ BỘ ĐIỀU KHIỂN PHI TUYẾN CHO ROBOT HÀN DI ĐỘNG Chuyên ngành: Cơ điện tử Người nhận xét: Cơ quan công tác: Ý KIẾN NHẬN XÉT 1-Về nội dung đánh giá thực nhiệm vụ nghiên cứu đề tài: 2-Về phương pháp nghiên cứu, độ tin cậy số liệu: 3-Về kết khoa học luận văn: 4-Về kết thực tiễn luận văn: 5-Những thiếu sót vấn đề cần làm rõ: 6-Ý kiến kết luận (mức độ đáp ứng yêu cầu LVThS): Sau thời gian hướng dẫn học viên thực đề tài, nhận thấy nội dung luận văn học viên đáp ứng yêu cầu Luận văn Thạc sĩ Do tơi đồng ý cho học viên…………………………………………bảo vệ trước Hội đồng đánh giá Luận văn TP HCM, ngày tháng năm 20… CÁN BỘ HƯỚNG DẪN (Ký ghi rõ họ tên) CƠNG TRÌNH ĐƯỢC HỒN THÀNH TẠI TRƯỜNG ĐẠI HỌC CÔNG NGHỆ TP HCM Cán hướng dẫn khoa học : TS NGUYỄN HÙNG Luận văn Thạc sĩ bảo vệ Trường Đại học Công nghệ TP HCM ngày 25 tháng 01 năm 2014 Thành phần Hội đồng đánh giá Luận văn Thạc sĩ gồm: TT Họ tên Chức danh Hội đồng PGS.TS Trần Thu Hà Chủ tịch TS Nguyễn Thanh Phuơng Phản biện TS Nguyễn Duy Anh Phản biện TS Võ Tường Quân TS Nguyễn Viễn Quốc Ủy viên Ủy viên, Thư ký Xác nhận Chủ tịch Hội đồng đánh giá Luận sau Luận văn sửa chữa (nếu có) Chủ tịch Hội đồng đánh giá LV TRƯỜNG ĐH CƠNG NGHỆ TP HCM CỘNG HỊA XÃ HỘI CHỦ NGHĨA VIỆT NAM PHÒNG QLKH – ĐTSĐH Độc lập – Tự – Hạnh phúc TP HCM, ngày 05 tháng 05 năm 2013 NHIỆM VỤ LUẬN VĂN THẠC SĨ Họ tên học viên: THÂN VĂN THẾ Ngày, tháng, năm sinh: 20/10/1965 Giới tính: Nam Nơi sinh: Bắc Giang Chuyên ngành: Cơ điện tử MSHV: 1241840016 I- Tên đề tài: THIẾT KẾ BỘ ĐIỀU KHIỂN PHI TUYẾN CHO ROBOT HÀN DI ĐỘNG II- Nhiệm vụ nội dung: - Nghiên cứu tổng quan robot hàn di động hai bánh xe - Xây dựng mơ hình tốn cho robot hàn Mơ hình hình học robot hàn, mơ hình động học, mơ hình động lực học robot hàn - Thiết kế điều khiển phi tuyến cho robot hàn - Thiết kế, chế tạo robot hàn - Chạy thực nghiệm robot hàn III- Ngày giao nhiệm vụ: Tháng năm 2013 IV- Ngày hoàn thành nhiệm vụ: 30 tháng 12 năm 2013 V- Cán hướng dẫn: TS NGUYỄN HÙNG CÁN BỘ HƯỚNG DẪN NGUYỄN HÙNG KHOA QUẢN LÝ CHUYÊN NGÀNH i LỜI CAM ĐOAN Tôi xin cam đoan luận văn với nội dung “THIẾT KẾ BỘ ĐIỀU KHIỂN PHI TUYẾN CHO ROBOT HÀN DI ĐỘNG” cơng trình nghiên cứu riêng tơi, hướng dẫn TS Nguyễn Hùng Các số liệu, kết mô thực nghiệm nêu luận văn trung thực, có nguồn trích dẫn chưa cơng bố cơng trình nghiên cứu khác Tơi xin cam đoan giúp đỡ cho việc thực luận văn cảm ơn thơng tin trích dẫn luận văn rõ nguồn gốc Học viên thực luận văn Thân Văn Thế ii LỜI CÁM ƠN Trong trình thực luận văn, nhận giúp đỡ nhiều từ thầy cô bạn Trước tiên, xin gửi lời cảm ơn sâu sắc, chân thành tới thầy giáo, TS Nguyễn Hùng – Phó Trưởng Khoa Cơ – Điện – Điện Tử Trường Đại Học Cơng Nghệ Tp.HCM tận tình hướng dẫn giúp đỡ tơi suốt q trình nghiên cứu thực luận văn Tôi xin chân thành gửi lời cảm ơn đến Ban Giám Hiệu Trường Đại học Kỹ thuật Cơng Nghệ Thành Phố Hồ Chí Minh, q thầy, tận tình truyền đạt kiến thức tạo điều kiện tốt cho lớp suốt học trình cao học Cuối cùng, tơi xin cảm ơn bạn động viên, giúp đỡ tơi hồn thành luận văn Tơi xin chân thành cảm ơn ! Học viên thực luận văn Thân Văn Thế TÓM TẮT Trong năm qua, nhiều nghiên cứu thực cho robot hàn sử dụng nhiều điều khiển khác [1-3] Trong tài liệu tham khảo [1], điều khiển phi tuyến đơn giản dùng để dò bám theo đường hàn cho trước, vào mơ hình động học mà bỏ qua phần động lực học hệ thống khí nhiễu từ bên ngồi Chung [2] đề xuất điều khiển trượt mà kết hợp phần động học động lực học với ràng buộc nhiễu từ bên ngoài, nhằm giải vấn đề dò theo đường hàn robot hàn Ngo [3] đề xuất điều khiển trượt thích nghi cho loại robot hàn trên, điều khiển trên, robot hàn khảo sát dựa vào mơ hình động học với thông số cho trước nhiễu từ bên ngồi Tuy nhiên vận tốc tuyến tính điểm hàn không giữ cố định thiết kế ban đầu Để giải vấn đề, luận thiết kế điều khiển trượt tích phân, tích hợp mơ hình động học mơ hình động lực học với ràng buộc nhiễu từ bên cho robot hàn để dò theo đường hàn cho trước Tính ổn định hệ thống chứng minh dựa vào lý thuyết ổn định Lyapunov Kết mô kết thực nghiệm trình bày nhằm minh họa tính hiệu điều khiển trượt tích phân Nội dung luận văn gồm có: - Nghiên cứu tổng quan robot hàn di động hai bánh xe - Xây dựng mơ hình tốn cho robot hàn Mơ hình hình học robot hàn mơ hình động học, mơ hình động lực học robot hàn - Thiết kế điều khiển phi tuyến cho robot hàn - Thiết kế, chế tạo robot hàn - Chạy thực nghiệm robot hàn - Kết luận hướng phát triển đề tài ABSTRACT In the past years, there are many researches have been done for the welding mobile robot (WMR) using many kind of controller [1-3] In [1], the simple nonlinear controller of WMR was applied for tracking reference welding path but considered only the kinematic model which ignored the mechanical system dynamic and external disturbances Chung, et al [2] proposed the sliding mode controller that integrates a kinematic controller and a dynamic controller with bounded external disturbances have been used to solve the path welding tracking problem for the WMR Ngo, et al [3] also proposed the adaptive sliding mode controller for the same WMR In the above controllers, the WMR is considered in terms of dynamic model with known parameters in the presence of external disturbances However, the linear velocity of welding point was not keep constant velocity smoothly as desired To solve the roblem, this research proposes a new nonlinear controller that makes the integration of a kinematic controller and a sliding mode dynamic controller with bounded external disturbances for the WMR to track a desired welding trajectory The system stability is proved using the Lyapunov stability theory The simulation results are shown to illustrate effectiveness of Integral sliding mode controller The main contents of the thesis are: - Research overview of the mobile welding robot two wheels - Develop mathematical models for robot welding Geometric modeling of welding robot kinematic model, the dynamics model of the welding robot - Design of nonlinear controllers for robot welding - Design, fabrication welding robot - Run welding robot experiments - Conclusions and directions of development topics TÀI LIỆU THAM KHẢO [1] T H Bui, T T Nguyen, T L Chung, and S B Kim, “A Simple Nonlinear Control of a Two-Wheeled Welding Mobile Robot,” International Journal of Control, Automation, and Systems, Vol 1, No 1, pp 35-42, 2003 [2] T L Chung, T H Bui, T T Nguyen and S B Kim, “Sliding Mode Control of Two-Wheeled Welding Mobile Robot for Tracking Smooth Curved Welding Path,” KSME International Journal, Vol 18, No 7, pp.1094-1106, 2004 [3] M D Ngo, H D Vo, T P Nguyen,S B Kim and M S Oh “Two-Wheeled Welding Mobile Robot for Tracking Smooth Curved Welding Path Using Adaptive Sliding Mode Control Technique,” International Journal of Control, Automation, and Systems (IJCAS), Vol 5, No 3, pp 283-294, June 2007 [4] N Hung, Tuan D V, Jae S I, H K Kim and S B Kim, “Motion Control of Omnidirectional Mobile Platform for Trajectory Tracking Using Integral Sliding Mode Controller”, International Journal of Control, Automation, and Systems (IJCAS), Vol 8, No 1, February 2010 [5] Jean-Jacques E Slotine and Weiping Li, Applied Nonlinear Control, PrenticeHall International, Inc., 1991 [6] PGS.TS Nguyễn Thị Phương Hà, Huỳnh Thái Hoàng, Lý thuyết điều khiển tự động, Nhà xuất Đại học Quốc gia Tp HCM, 2010, 378 trang [7] TS Nguyễn Như Hiền & TS Lại Khắc Lãi, Hệ mờ & Nơron kỹ thuật điều khiển, NXB Khoa học tự nhiên công nghệ, 2007, 170 trang [8] TS Phạm Đăng Phước, Rô bốt công nghiệp, NXB Xây dựng, 2010, 98 trang [9] Nguyễn Phùng Quang, Matlab & Simulink dành cho kỹ sư điều khiển tự động, Nhà xuất khoa học kỹ thuật, Hà Nội 2008, 481 trang [10] PGS.TS Dương Hoài Nghĩa, Cơng nghệ tính tốn mềm, Đại Học Bách Khoa TP HCM [11] Nguyễn Doãn Phước, Phan Xuân Minh, Lý thuyết điều khiển mờ, Nhà xuất Khoa học Kỹ thuật, Hà Nội - 2002 PHỤ LỤC Chương trình lập trình điều khiển Chứng minh mơ hình động học, động lực học robot điều khiển trượt tích phân robot 2.1 Mơ hình động học Xét hệ thống robot có nhiều chiều khơng gian với vecto tọa độ q  (q1 ,  , qn ) với m rang buộc theo biểu thức sau : A(q)q  (1) Với A(q )  R ma trận chứa ràng buộc mn Mơ hình động học tác dụng ràng buộc nonholonomic viết sau : q  J(q)z (2) với J(q) ma trận đầy đủ a n  (n  m) thỏa mãn T T J (q)A (q)  z  R vecto vận tốc n m Đầu tiên vị trí robot xác định không gian Đề-các C(x,y) sau : q  [, , ]T (3) Nếu robot có ràng buộc nonholomonic nghĩa bánh xe quay đơn không bị trựơt A(q) (1) viết thành : A(q)   cos  (4) sin  0 Từ (3) (4) ; n=3 , n=1 vecto vận tốc (2) xác định : z  v (5)  T Trong mơ hình động học (2) J(q) cos  0   J(q)  sin    (6) Mối quan hệ v,ω vận tốc bánh lái xác định b / v   rw  1/ r   lw  1/ r r  b / r    (7) Thứ hai, phương trình động học điểm hàn W ( X w ,Yw ) gắn cố định tay hàn nhơ từ tâm robot C( X ,Y ) sau : [6] Xw  XP l sin   Yw  YP  l cos    w   (8) Đạo hàm phương trình (8) ta có : X w  cos  Y    w   sin   w  0 l cos   v P   l sin        P  lsin        l cos      (9)  Với điều khiển động lái đầu mỏ hàn Tọa độ ( X r ,Yr ) góc tham chiếu điểm tham chiếu R, di chuyển theo đường hàn tham chiếu với vận r tốc cố định cho trước v r , thỏa mãn công thức : r X  r  v   cos     r  Yr  v r s  r  r (10) Theo (2), vecto sai số e  [e 1, e , e3 ]T xác định độ khác biệt điểm hàn điểm tham chiếu Mối quan hệ vecto sai số tọa độ tuyệt đối tọa độ robot hàn diễn đạt sau : 0  X r  X P   e1  cos  sin     e   sin 2     e cos  0   r  Y Y P  r   P (11) Đạo hàm bậc vecto sai số là: e1    e2  l  v r cos e3   v  P      e  v sin e   e   l P  2     r  e3    r (12) 2.2 Động lực học robot: Phương trình động lực học hệ thống khí có ràng buộc nonholomic (1) mô tả dạng eu’er-lagrange sau [s] : M(q) q  V(q, q )q  B(q)τ  AT (q)λ Với M (q)  R ma trận quán tính dương đối xứng nxn V (q, q)  R nxn ma trận corilis ma trận hướng tâm B(q)  R ma trận chuyển vị tín hiệu vào nxn A(q)  R ma trận ràng buộc nonholonomic nxn (13)  n R vecto điều khiển tín hiệu đầu vào  vecto lực ràng buộc n R để đơn giản, giả sử r = n – m T Đạo hàm (2) thay kết váo (13) nhân với Ʈ , ma trận ràng buộc A T (q)λ bị lựơt bỏ động lực học robot với ràng buộc (1) sau : J MJ z  J (MJ  VJ) z  J Bτ T T T (14) Nhân với (J T B) 1 , từ (14) viết lại là: (15) M(q) z  V(q, q ) z  τ Trong luận văn này, trạng thái robot hàn có diện nhiễu bên ngồi τd  R r1 để xem xét, chương trình động học thực tế robot hàn với nhiễu bên rút từ (15) sau : M(q) z  V(q, q ) z  τ d  (16) τ Giả sử vecto nhiễu diễn tả ma trận cấp số nhân M(q) sau: τ d  M(q)f Với f  R(n m)1 vecto nhiễu bên hệ thống Bằng cách tuyến tính hóa phản hồi hệ thống vecto điều khiển u  R (n m)1 xác định cách tính momen xoắn sau : τ  M(q) z d  V(q, q ) z  M(q) u (17) Với z d  (nm)1 vecto đầu vào Từ (15), 17) ta có : R f  u  z  z (18) d Với q  x, y, , n=3 ; m=1 ; r=2 Ta có hệ số sau : T   r2 mc d 2b   m d 0  V   rc 2b r 2 (19)  r2 (mb  I )  4b I)Iw  (mb M  4b   r (mb  I  ) 4b   r (mb  I )  I w   4b I  mc d  2mwb  I c  2I m m  mc  2m w, z= [x  = [  lw ]  (20) T ] , z d = [ vd  d ] T T rw f = [ f1 f ]T 2.3 Thiết kế điều khiển trượt tích phân Bộ điều khiển trượt tích phân cho rơbốt thiết kế mơ hình động học động lực học Điểm tham chiếu R(xr , yr , r ) di chuyển theo đường dẫn cho trước với vận tốc cố định Trong hình véc tơ sai số e  e , , e e điểm hàn w điểm tham chiếu R( xr , yr , r )  xác định sai số sau: e  cos  e  e2   sin  e sin  cos   0  xr xw   yr yw 1  r   w  (21) Mục đích toán thiết kế điều khiển phi tuyến điểm hàn W dò theo điểm tham chiếu R nghĩa làm cho sai số e  , t  Xét trường hợp chiều dài mỏ hàn điều khiển sử dụng cấu trượt mỏ hàn Đạo hàm bậc phương trình (21) ta được: e  1 e e   e    0  e     l  v r cos e3   v     v sin e i  r e  1   r    (22) Hàm Lyapunov định nghĩa sau: V  V1  V2  đó: (23) V1  (e1  e2  e3 2)  (24) Từ (13) đạo hàm ta có : V1  e1e1  e2 e2  e3e3 Thay vào (11) ta có: V  e1 (v  e2    vr cos e3 )  e2 (e1  vr )  e3 (  r ) sin e3  V2   S S0 Sv  Sv1 Sv  véc tơ mặt trượt Luật điều khiển động lực học thiết kế sau [1]: v  l(R  C3e3 )  vR cos e3  C1e1  z d   d   (26)  R  C e3  wd    Chiều dài mỏ hàn thỏa mãn: (25) l  v R sin e3  C 2e  (27) Với C1 , C2 , giá trị dương C3  Với vận tốc điều khiển (26) V1 trở thành : V1 2  C22e2 3 C e C1e1 0 (28) Véc tơ mặt trượt S v định nghĩa sau: S v  ev  K v  ev dt  Với  z ev1 ev  ev  z d   (29) x1  2R vectơ sai số vận tốc K làv ma trận đường chéo dương Đạo hàm Sv sau: (30) Sv = ev + Kv ev = (zd - z) + Kv ev Thay (18) vào (31) rút gọn, ta phương trình sau:  Sv  f  u  (31) (zd  z)  Kv ev Luật điều khiển u  u1 u  thiết kế sau: u  QSv  Psign(Sv )  Kv ev (32) Ta có Sv1  0 Q1 1P Sv   Q P  ; ;  Q2  0 0 Sv2  0 P2  ; f  m f1  f  m  f  f   Qi Pi , i  1,2 số dương f m i , i  1,2 giới hạn f i Với luật điều khiển (32), (31) trở thành: Sv = v  Psign(Sv ) + f (33) QS Thay (33) vào phương trình đạo hàm bậc V2 V2 = SvT  -ST QS - S (P1 m )  S Sv f1 v v v f2 ) v Nếu chọn Qi Pi  f m i 2 m (P2  (34) ,i  1.2 V 0 Theo bổ đề Barbalat, Sv  t  , nghĩa tồn luật điều khiển u ổn định mặt trượt tiến không Từ (23) đến (25) (28), (33), V  Nghĩa hai e  ev  , kết điểm W rô bốt bám theo điểm tham chiếu R chuyển động theo đường cong tham chiếu với vận tốc không đổi mong muốn ... quan robot hàn di động hai bánh xe - Xây dựng mô hình tốn cho robot hàn Mơ hình hình học robot hàn mơ hình động học, mơ hình động lực học robot hàn - Thiết kế điều khiển phi tuyến cho robot hàn. .. hình hình học robot hàn, mơ hình động học, mơ hình động lực học robot hàn - Thiết kế điều khiển phi tuyến cho robot hàn - Thiết kế, chế tạo robot hàn - Chạy thực nghiệm robot hàn III- Ngày giao... tài: THIẾT KẾ BỘ ĐIỀU KHIỂN PHI TUYẾN CHO ROBOT HÀN DI ĐỘNG II- Nhiệm vụ nội dung: - Nghiên cứu tổng quan robot hàn di động hai bánh xe - Xây dựng mơ hình tốn cho robot hàn Mơ hình hình học robot