1. Trang Chủ
  2. Tự động hoá
  3. Điều khiển bám quỹ đạo đối tượng robot tự hành bằng thuật toán điều khiển trượt theo hàm mũ

Điều khiển bám quỹ đạo đối tượng robot tự hành bằng thuật toán điều khiển trượt theo hàm mũ

Bài viết này đề xuất thuật toán điều khiển trượt theo hàm mũ, ứng dụng vào bài toán điều khiển bám quỹ đạo cho đối tượng mobile robot. Đây là một cách giải quyết mới cho vấn đề giảm rung (chattering) của điều khiển trượt. Bộ điều khiển trượt theo hàm mũ được xây dựng để giảm hiện tượng rung và đảm bảo chất lượng động học tốt ở chế độ xác lập cho mobile robot. Nghiên cứu khoa học công nghệ ĐIỀU KHIỂN BÁM QUỸ ĐẠO ĐỐI TƯỢNG ROBOT TỰ HÀNH BẰNG THUẬT TOÁN ĐIỀU KHIỂN TRƯỢT THEO HÀM MŨ Hà Thị Kim Duyên

Thể loại Tài liệu miễn phí Tự động hoá

Số trang 8

Ngày tạo 9/14/2019 2:07:55 PM +00:00

Loại tệp PDF

Kích thước 0.34 M

Tên tệp

Tải Điều khiển bám quỹ đạo đối tượng robot tự hành bằn... (.pdf)

Xem mẫu

  1. Nghiên cứu khoa học công nghệ ĐIỀU KHIỂN BÁM QUỸ ĐẠO ĐỐI TƯỢNG ROBOT TỰ HÀNH BẰNG THUẬT TOÁN ĐIỀU KHIỂN TRƯỢT THEO HÀM MŨ Hà Thị Kim Duyên 1*, Phạm Thị Thanh Huyền1, Trương Bích Liên1, Ngô Mạnh Tiến2*, Lê Việt Anh3, Nguyễn Mạnh Cường3 Tóm tắt: Bài báo này đề xuất thuật toán điều khiển trượt theo hàm mũ, ứng dụng vào bài toán điều khiển bám quỹ đạo cho đối tượng mobile robot. Đây là một cách giải quyết mới cho vấn đề giảm rung (chattering) của điều khiển trượt. Bộ điều khiển trượt theo hàm mũ được xây dựng để giảm hiện tượng rung và đảm bảo chất lượng động học tốt ở chế độ xác lập cho mobile robot. Thuật toán này điều khiển robot di chuyển theo quỹ đạo mong muốn trong khi giảm thiểu các giá trị sai lệch bám. Kết quả mô phỏng đạt được với sự so sánh giữa bộ điều khiển trượt theo hàm mũ và chế độ trượt thông thường. Từ khóa: Mobile Robot, Exponential Sliding Mode, Nonlinear Control, Tracking Control. Ký hiệu Đơn vị Ý nghĩa I 2 g.cm Mô men quán tính xe Robot m G Khối lượng xe Robot 1  2 Nm Mô men động cơ trái, phải  Hệ số lực ràng buộc Lagrange 2L Cm Chiều ngang của xe Robot r Cm Bán kính của bánh xe Robot Chữ viết tắt: ESM Exponential Sliding Mode SMC Sliding Mode Controller MR Mobile Robot 1. ĐẶT VẤN ĐỀ Robot tự hành là một hệ Robot có khả năng thực hiện các nhiệm vụ ở nhiều vị trí khác nhau với khả năng dịch chuyển bằng bánh xe, xích hay bằng chân phụ thuộc vào địa hình. Khả năng di động làm Robot có nhiều ứng dụng và đòi hỏi phải giải quyết nhiều vấn đề mới và được tập trung nghiên cứu, phát triển nhằm tăng cường sự thích nghi và thông minh cho Robot. Những vấn đề nghiên cứu đang được nhiều tác giả trên thế giới quan tâm cho lĩnh vực Robot tự hành là điều khiển thích nghi Robot bám theo quỹ đạo đặt trước mong muốn, đặc biệt là khi Robot có các tham số thay đổi và chịu tác động bởi các nhiễu tác động, các thuật toán điều khiển thông minh [2, 3, 4], backstepping [7], phương pháp tuyến tính hóa và thuật toán điều khiển trượt [6, 8]. Điều khiển trượt được sử dụng bởi tính bền vững, đáp ứng nhanh, luật điều khiển đơn giản, đặc tính quá độ tốt. Bộ điều khiển trượt có thể được ứng dụng cho một lớp rộng hệ thống phi tuyến với độ bền vững với các tham số bất định và các nhiễu tác động. Tuy nhiên, hạn chế của thuật toán SMC chính là hiện tượng chattering, là vấn đề đang rất được quan tâm. Ba thuật toán chính được đề xuất để loại bỏ và giảm thiểu hiện tượng đó trong SMC là: Sử dụng điều khiển bão hòa thay vì không liên tục, sử dụng bộ quan sát và sử dụng chế độ trượt bậc cao. Mục đích của bài báo này là đề xuất một thuật toán điều khiển trượt mới để giảm hiện tượng chattering với chế độ trượt theo hàm mũ. 2. MÔ HÌNH HÓA ĐỐI TƯỢNG MOBILE ROBOT Một lớp rộng các hệ thống cơ non-holonomic được mô tả bởi dạng công thức động lực học sau dựa trên công thức Euler-Lagrange [2,7]: Tạp chí Nghiên cứu KH&CN quân sự, Số Đặc san ACMEC, 07 - 2017 19
  2. Điều khiển – Cơ điện tử - Truyền thông M (q)q  C (q, q )q  G (q)  B(q)  J T (q) (1) Với điều kiện ràng buộc non-holonomic là: J (q )q  0 Trong đó: + q là vector n chiều ứng với n các biến khớp, M(q) là ma trận đối xứng xác định dương cỡ n x n, C (q, q )q là thành phần mô-men Coriolis và hướng tâm, G(q) là n vectơ mô-men trọng lực, B(q) là ma trận chuyển đổi đầu vào cỡ n x r (r
  3. Nghiên cứu khoa học công nghệ Trong đó: + 1 và  2 lần lượt là moment của động cơ trái và động cơ phải. + m và I thể hiện khối lượng và moment tương ứng của rô bốt. + r là bán kính của bánh lái và R là một nửa của khoảng cách giữa 2 bánh lái đằng sau. Ràng buộc non-holonomic trong điều kiện không trượt: x sin   yc  os  0 (4) 3. BỘ ĐIỀU KHIỂN TRƯỢT HÀM MŨ Hình 2. Sơ đồ biểu diễn trục tọa độ điều khiển Robot tự hành bám quỹ đạo [2, 3]. q  x y   là tọa độ Robot trong hệ cố định, qr   xr r  là tọa độ Robot mong T T yr muốn trong hệ cố định, qe   xe e  T ye là các sai số trong hệ tọa độ di động,  v(q , q )  u   e r  : Bộ điều khiển bám quỹ đạo đưa ra các giá trị vận tốc.  w(qe , qr )   Phương trình liên hệ các tọa độ của hệ quy chiếu cố định trong hệ quy chiếu di động: Ma trận liên hệ giữa vi phân của các biến tọa độ, hướng trong hệ cố định với vận tốc của 2 bánh trái và phải: c( R cos  ) c( R cos  )  R(q)   c( R sin  ) c( R cos  )  (5)  c c  r Thỏa mãn: A(q)q  0 , trong đó: c  2 R Mô hình có trọng tâm C giữa xe nên C (q, q )  0 , theo (1): M (q)q  B(q)  AT (q) Nhân với RT : RT M (q )q  RT B(q )  RT AT (q )  RT M (q )q  RT B (q )    ( RT B(q )) 1 RT M (q )q  J (q )q (6) Sai số động lực học thì được viết độc lập so với hệ quy chiếu quán tính bởi phép chuyển đổi Kanayama [7]: Tạp chí Nghiên cứu KH&CN quân sự, Số Đặc san ACMEC, 07 - 2017 21
  4. Điều khiển – Cơ điện tử - Truyền thông  xe   cos  sin  0     qe   ye    sin  cos  0 (qr  q)  T (qr  q) (7)     e   0 0 1 Trong đó: g là ma trận liên hệ giữa các sai số trong hệ tọa độ di động và các sai số tọa  cos  sin  0   độ trong hệ quy chiếu cố định: T   sin  cos  0 ,    0 0 1  xe   cos  sin  0  xr  x         ye    sin  cos  0  yr  y  (8)    0 0 1  r     e  Mặt khác:  qe  T ( qr  q )   qe  T ( qr  q )  T (qr  q ) (9)     qe  T ( qr  q )  T (qr  q)  2T (qr  q ) Ràng buộc non-holonomic trong điều kiện không trượt ta có: x r sin r  y r cosr nên [2, 7]: x e  x  ( xr  x)cos  ( yr  y ) sin   xr  x   sin  ( yr  y )cos  ye w  v  xr cos  yr sin  ye w  v  xr cos (r  e )  y r sin(r  e ) (10)  ye w  v  xr (cosr cose  sinr sine )  y ( sinr cose  cosr sine )  ye w  v   x r cosr  yr sinr  cos e   x r sinr  yr cosr  sin e  ye w  v  vr cose y e  ( xr  x) sin   y r  y  cos    xr  x cos   yr  y   sin    y os  x r sin  y r cos  xe w  xsin  xe w  x r sin(r  e )  y r cos (r  e ) (11)  xe w  x r ( sinr cose  cos r sine )  y r (cosr cose  sinr sine )  xe w  ( x r cosr  y r sinr ) sin e  ( y r cosr  x r sinr )cose  xe w  vr sine e  r    wr  w (12) Hình 3. Cấu trúc hệ thống điều khiển đối tượng Robot tự hành. Ta có hệ các biến trạng thái sai lệch tọa độ, hướng: 22 H.T.K. Duyên, P.T.T. Huyền, …, “Điều khiển bám quỹ đạo… trượt theo hàm mũ.”
  5. Nghiên cứu khoa học công nghệ  xe   vr cose  1 ye        v  y e   vr sin e    0 xe    (13)            w   0 1   w    e r    Sử dụng mặt trượt (bậc 2): d S (   )n 1 e dt (14) if n  2  S  e   e Khi s->0 ở chế độ trượt cũng tương đương thì khi đó do >0 nên đa thức đặc tính là Hurwith nên dùng hàm Lyapunov sau để tìm cách khiến s->0 1 T V S S  V  S T S (15) 2 Để V có đạo hàm 0  V
  6. Điều khiển – Cơ điện tử - Truyền thông K K K 0 , và do đó, Q ( S ) dần tới , giá trị này lớn hơn K. Điều đó chứng tỏ Q ( S ) tăng miền 0 pha và tương đương với sức hút về mặt trượt sẽ nhanh hơn. Mặt khác, nếu S giảm thì K K Q ( S ) dần tới K. Điều này có nghĩa là khi hệ thống tiến gần về mặt trượt, Q ( S ) giảm dần để hạn chế hiện tượng chattering. Và nếu chúng ta chọn  0  1 thì từ phương trình luật điều khiển (22) và (14), ta có chế độ trượt theo hàm mũ trở thành chế độ trượt thông thường. 4. KẾT QUẢ MÔ PHỎNG Các thông số của robot: m=2.3kg, I=.01kg/m2, r= .04m, L= .1m - Kết quả với bộ điều khiển trượt thông thường: Conventional sliding mode 250 Conventional sliding mode quy dao dat 8 quy dao thuc xe ye 6 the 200 4 150 2 Y 100 0 -2 50 -4 0 -6 0 20 40 60 80 100 120 140 160 0 5 10 15 20 25 30 35 40 45 50 X time (s) (a) (b) Hình 4. Quỹ đạo bám của robot (a) và sai số tọa độ và góc (b). - Kết quả với bộ điều khiển trượt theo hàm mũ: Exponential sliding mode Exponential sliding mode 250 8 quy dao dat xe quy dao thuc ye 6 the 200 4 150 2 Y 0 100 -2 50 -4 0 -6 0 20 40 60 80 100 120 140 160 0 5 10 15 20 25 30 35 40 45 50 (a) X (b) time (s) Hình 5. Quỹ đạo bám của robot (a) và sai số tọa độ và góc (b). Nhận xét: Các kết quả mô phỏng cho thấy: với đối tượng robot tự hành dạng non- holonomic thì với bộ điều khiển trượt sử dụng hàm mũ cho chất lượng tốt hơn, thời gian xác lập nhanh hơn (hình 4 và hình 5). Đặc biệt là hiện tượng chattering được giảm hẳn về 24 H.T.K. Duyên, P.T.T. Huyền, …, “Điều khiển bám quỹ đạo… trượt theo hàm mũ.”
  7. Nghiên cứu khoa học công nghệ tần số và biên độ dao động khi sử dụng bộ điều khiển trượt hàm mũ (hình 7) so với việc dao động liên tục khi sử dụng bộ điều khiển thông thường. Exponential sliding mode Conventional sliding mode 10 10 v v 9 9 8 8 7 7 6 6 5 5 4 4 3 3 2 2 1 1 0 0 5 10 15 20 25 30 35 40 45 50 0 time (s) 0 5 10 15 20 25 30 35 40 45 50 time (s) (a) (b) Hình 6. Vận tốc của robot khi sử dụng bộ trượt thông thường (a) và khi sử dụng bộ điều khiển hàm mũ (b). Conventional sliding mode Exponential sliding mode 8 v v 7.5 7.5 7 7 6.5 6.5 6 6 5.5 5.5 0 2 4 6 8 10 12 0 5 10 15 20 25 time (s) time (s) (a) (b) Hình 7. Zoom vận tốc của robot khi sử dụng bộ trượt thông thường (a) và khi sử dụng bộ điều khiển hàm mũ (b). 5. PHẦN KẾT LUẬN Trong bài báo này, cả hai bộ điều khiển trượt thông thường và theo hàm mũ được áp dụng vào đối tượng robot tự hành dạng non-holonomic. Thuật toán điều khiển trượt cải tiến theo hàm mũ được đưa ra nhằm giảm hiện tượng chattering và tăng khả năng bám cho đối tượng robot. Căn cứ vào kết quả mô phỏng, cho ta thấy thuật toán cải tiến theo hàm mũ đã cho thấy chất lượng tốt hơn so với bộ điều khiển trượt thông thường, đặc biệt là trong vấn đề giảm hiện tượng chattering. TÀI LIỆU THAM KHẢO [1]. Nguyễn Doãn Phước, Phan Xuân Minh, Hán Thành Trung, “Lý thuyết điều khiển phi tuyến”, NXB Khoa học Kỹ thuật, 2008. [2]. Tien-Ngo Manh, Minh-Phan Xuan, Phuoc-Nguyen Doan, Thang-Phan Quoc, “Tracking Control for Mobile Robot with Uncertain Parameters Based on Model Reference Adaptive Control”, International Conference on Control, Automation and Information Sciences ICCAIS2013; IEEE catalog number: CFP1226S-CPR; ISBN: 978-1-4673-0811-1;11/2013 Tạp chí Nghiên cứu KH&CN quân sự, Số Đặc san ACMEC, 07 - 2017 25
  8. Điều khiển – Cơ điện tử - Truyền thông [3]. Hasan Mehrjerdi, Maarouf Saad. “Dynamic tracking control of Mobile Robot using exponential sliding mode”, IEEE Tran. On Automatic Control, 36, pp. 1517-1521, (2010). [4]. O.J. Sordalen, O. Egeland. “Exponential stabilization of nonholonomic chained systems”, IEEE Tran. On Automatic Control, 40, 1, pp. 35-49, (1995). [5]. Walsh, Tillbury, Sastry, Murray, Laumond. “Stabilization of trajectories for systems with nonholonomic constraints”, IEEE Tran. On Automatic Control, 39, pp. 216-222, (1994). [6]. Y. Kanayama, Y. Kimura, F. Miyazaki, T. Noguchi. “A stable tracking control scheme for an autonomous mobile Robot”, proc. of IEEE Int. Conf. on Robotics and Automation, pp. 384-389, (1990). [7]. Z.P. Jiang, H. Nijmeijer. “Tracking control of mobile Robots: A case study in Backstepping”, Automatica, 33, 7, pp. 1393-1399, (1997). [8]. A.M. Bloch, M. Reyhanoglu, H. McClamorch. “Control and stabilization of nonholonomic dynamic systems”, IEEE Tran. On Automatic Control, 37, 11, pp. 1746- 1757, (1992). ABSTRACT TRAJECTORY TRACKING CONTROL OF NON-HOLONOMIC MOBILE ROBOTS USING EXPONENTIAL SLIDING MODE In this paper, an exponential sliding mode control for trajectory tracking of nonholonomic wheeled mobile Robots is presented. A new solution to the problem of chattering in variable structure control is proposed. Exponential sliding mode is defined to reduce chattering and keep high dynamic tracking performance in steady state mode for mobile Robot. This algorithm instructs the Robot to keep moving on the desired path while reduce tracking errors. The simulation results obtained with unicycle mobile Robot is presented to demonstrate the performance of exponential sliding mode controller algorithm compare to conventional sliding mode. Keywords: Mobile Robot, Exponential Sliding Mode, Nonlinear Control, Tracking Control. Nhận bài ngày 02 tháng 5 năm 2017 Hoàn thiện ngày 10 tháng 6 năm 2017 Chấp nhận đăng ngày 20 tháng 7 năm 2017 1 Địa chỉ: Đại học Công nghiệp Hà Nội; 2 Viện Vật Lý/Viện Hàn lâm KH&CN Việt Nam; 3 Đại học Bách khoa Hà Nội. * E-mail: hkduyendt@gmail.com; nmtien@iop.vast.ac.vn. 26 H.T.K. Duyên, P.T.T. Huyền, …, “Điều khiển bám quỹ đạo… trượt theo hàm mũ.”
nguon tai.lieu . vn
Kiến trúc - Xây dựng Tự động hoá Điện - Điện tử Kĩ thuật Viễn thông Cơ khí - Chế tạo máy Năng lượng Hoá dầu Hoá học Sinh học