Tài liệu hạn chế xem trước, để xem đầy đủ mời bạn chọn Tải xuống
1
/ 24 trang
THÔNG TIN TÀI LIỆU
Thông tin cơ bản
Định dạng
Số trang
24
Dung lượng
1,83 MB
Nội dung
MỞ ĐẦU Tính cấp thiết đề tài Những năm gần đây, hệ thiếu cấu chấp hành nghiên cứu ngày nhiều Trong hệ thống tàu thủy, tàu ngầm, máy bay, tàu vũ trụ, robot,… thiết kế thiếu cấu chấp hành, với mục đích để giảm giá thành, giảm trọng lượng, giảm tiêu hao lượng tiêu thụ Một số trường hợp hệ trở thành thiếu cấu chấp hành hệ thống có thiết bị chấp hành bị lỗi Trên thực tế, giảm số thiết bị chấp hành việc phát triển kỹ thuật điều khiển cần thiết khó khăn so với hệ đủ cấu chấp hành Các cơng trình nghiên cứu hệ UMS thập niên gần cứu tập trung nhiều đến việc thiết kế thuật toán điều khiển cho hệ UMS phi tuyến, đặc biệt phải xét đến yếu tố bất định, mơ hình khơng xác, nhiễu tác động vào hệ thống Các đối tượng thiếu cấu chấp hành đa dạng, có hệ động lực học khác nên phương pháp điều khiển đa dạng, cần nghiên cứu riêng cho đối tượng Xe tự hành (viết tắt WMR) thuộc lớp đối tượng robot di động, di chuyển mặt đất bánh xe, ứng dụng rộng rãi nhiều lĩnh vực nhà máy để vận chuyển hàng hóa, ngun vật liệu, hay xe dị đường, tìm kiếm cứu nạn Khi môi trường làm việc độc hại, nguy hiểm, việc vận chuyển hàng hóa liên tục theo lộ trình cố định nhà máy việc điều khiển xe tự hành bám theo quỹ đạo cho trước trở lên cần thiết có ý nghĩa thực tế Xe tự hành ba bánh đối tượng thiếu cấu chấp hành, góc hướng xe khơng có cấu chấp hành để can thiệp trực tiếp, đối tượng phi tuyến có ràng buộc non-holonomic Mặt khác, xe di chuyển tồn ma sát bánh xe với mặt sàn khó xác định cách đo tính tốn, việc xác định mơ hình ln tồn sai số gây khó khăn cho việc thiết kế điều khiển Mục tiêu nghiên cứu: Xe tự hành ba bánh đối tượng phổ biến, nhiên, hoạt động xác xe phụ thuộc nhiều vào phương án điều khiển sử dụng xe đối tượng thiếu cấu chấp hành Việc thiết kế điều khiển cho xe ba bánh tự hành thách thức đối tượng có mơ hình phức tạp, trình hoạt động chịu nhiều tác động môi trường làm việc Mục tiêu nghiên cứu luận án nghiên cứu mơ hình tốn học điều kiện làm việc xe ba bánh tự hành, từ ứng dụng điều khiển thích nghi phi tuyến, điều khiển thích nghi mờ để giải toán bám quỹ đạo cho xe đạo có xét đến nhiễu tác động vào xe Đối tượng phạm vi nghiên cứu: Đối tượng nghiên cứu xe tự hành ba bánh, hai bánh chủ động phía sau bánh tự lựa hướng phía trước mơ tả phương trình động học, động lực học hệ phi tuyến, non-holonomic chịu ảnh hưởng nhiễu tác động Phạm vi nghiên cứu xây dựng mơ hình tốn học cho hệ xe ba bánh tự hành, từ đề xuất điều khiển bám trường hợp nhiễu tác động có biên độ nhỏ Ứng dụng điều khiển thích nghi cho xe tự hành bám quỹ đạo có xem xét bù trượt bánh xe để nâng cao chất lượng điều khiển xe Ý nghĩa khoa học đề tài Về lý luận: Luận án nghiên cứu xây dựng cấu trúc, phương pháp điều khiển cho xe tự hành đáp ứng yếu tố bất định, nhiễu ma sát trượt bánh Về thực tiễn: Các điều khiển đề xuất có khả thực thi sở kỹ thuật số, có khả đáp ứng điều kiện làm việc môi trường phức tạp Bố cục luận án Luận án bao gồm chương, chương giới thiệu hệ thiếu cấu chấp hành, mơ hình chung hệ điện thiếu cấu chấp hành, xây dựng mơ hình động học động lực học WMR Nghiên cứu phân loại phương pháp điều khiển, đề xuất hướng nghiên cứu luận án Chương tổng hợp điều khiển trượt tầng backstepping chỉnh định mờ cấu trúc mạch vòng Chương tổng hợp điều khiển thích nghi dựa ước lượng nhiễu cấu trúc hai mạch vòng Chương tổng hợp điều khiển thích nghi mờ loại cấu trúc hai mạch vòng Cuối phần kết luận, đề xuất hướng phát triển đề tài, cơng trình công bố luận án CHƯƠNG TỔNG QUAN VỀ HỆ THIẾU CƠ CẤU CHẤP HÀNH VÀ XE TỰ HÀNH 1.1 Giới thiệu chung hệ thiếu cấu chấp hành Hệ thiếu cấu chấp hành hệ điều khiển có số thiết bị chấp hành số bậc tự số biến mơ hình, tức hệ có số bậc tự khơng cấu chấp hành tác động trực tiếp, biến phụ thuộc Các hệ thiếu cấu chấp hành điện mơ hình động lực học thiết lập từ phương trình Euler Lagrange, có dạng tổng qt sau: M (q)q C (q)q g (q) E (q)u τ d (t ) (1.5) Trong q q1 , q2, , qn đó: T vector biến khớp u u1 , u2 , , um vector tín hiệu điều khiển, với m số tín T hiệu đầu vào, hệ thống thiếu cấu chấp hành n m τ d (t ) xem thành phần tín hiệu nhiễu tác động lên hệ thống, giả thiết bi chặn M (q) Rnn ma trận quán tính C (q) ma trận liên quan lực hướng tâm lực Coriolis 1.2 Mô hình xe tự hành ba bánh 1.2.1 Mơ hình động học Tọa độ OXY hệ tọa độ cố định MX Y hệ tọa độ cục gắn xe, ( x, y ) tọa độ trọng tâm xe hệ tọa độ cố định Góc 𝜃 góc quay trục X so với trục X , gọi góc hướng xe Như vậy, vị trí hướng xe hoàn toàn xác định vector q x, y, Vận tốc bánh xe WMR điều khiển T động độc lập Gọi vận tốc tịnh tiến 𝜔 vận tốc quay, chuyển động xe mô tả phương trình động học: x cos a sin (1.14) y sin a cos Giả thiết: max , max với max , max tốc độ lớn Khi xe khơng bị trượt chuyển động với điều kiện ràng buộc non-holonomic: (1.15) xsin ycos a Viết dạng vector: A1 q q (1.16) Hình 1.2: Mơ hình xe tự hành ba bánh 1.2.2 Mơ hình động lực học Xe tự hành di chuyển mặt sàn nên thành phần g 0, bỏ qua thành phần tiêu tán công suất ma sát giảm sóc P, mơ hình tốn học cấu chấp hành thiết bị cảm biến xe coi lý tưởng, chưa xét đến nhiễu, gọi q x, y, vector tọa độ biến đầu ta có phương trình đơn giản là: T T T m d L L F jaj (1.18) dt q q j 1 Tính hàm Lagrange thành phần đạo hàm (1.18) ta có: mx sin r R L cos (1.24) my cos R L sin r b I a r R L Biểu diễn dạng vector: M1q E1 q τ A1T q (1.25) 1.2.3 Mơ hình xe tự hành xét đến yếu tố nhiễu hệ thống Trong trường hợp xe di chuyển vào khúc cua di chuyển với tốc độ cao, mặt sàn trơn, có vật cản, xảy tượng trượt bánh xe, ảnh hưởng đến tốc độ vị trí xe Để hiểu rõ ảnh hưởng ma sát trượt bánh lên hệ thống thuận tiện cho việc thiết kế điều khiển, thành phần ma sát trượt bánh đưa vào mơ hình động học, động lực học xe Gọi F1 , F2 , F3 lực dọc trục bánh xe bên phải, bên trái, tổng lực ma sát ngang trục bánh xe Hình 1.3: Xe tự hành ba bánh xét đến yếu tố trượt bánh Gọi R L độ trượt dọc trục bánh xe bên phải bên trái, η độ trượt ngang trục bánh xe Phương trình chuyển động xe xét điểm tâm khối G xe: x cos sin a sin (1.33) y sin cos a cos Với điều kiện ràng buộc non-holonomic: R rR x cos y sin b (1.34) L rL x cos y sin b x sin y cos a Với a khoảng cách M tâm khối G Ta đặt q x, y, , , R , L ,R ,L vector tọa độ suy rộng Lagrange, điều kiện ràng buộc non-holonomic (1.34) biểu diễn dạng vector sau: A2 q q (1.35) T Cơ cấu xe tự hành xe di chuyển mặt sàn ngang, trọng tâm khối lượng xe trùng với trọng tâm hình học xe Mơ hình động lực học xe tự hành mơ tả theo phương trình Lagrange: M q E2 τ A2T q λ (1.38) Phương trình động lực học (1.38) biến đổi dạng: M v B(v )v E2 v Qγ c g τ (1.41) 1.3 Tình hình nghiên cứu tổng quan phương pháp điều khiển xe tự hành 1.3.1 Tình hình nghiên cứu nước Với xu hướng đại hóa tự động hóa ngành cơng nghiệp nay, việc nghiên cứu ứng dụng xe tự hành nhà máy xí nghiệp ngày nhiều Trong nước có số đề tài nghiên cứu điều khiển WMR, thể quan tâm vai trò đối tượng Luận án tác giả Ngô Mạnh Tiến [15] thiết kế điều khiển thích nghi theo mơ hình mẫu, sử dụng camera phần mềm xử lý ảnh để xác định mục tiêu cho xe bám Phương pháp giải thuật học củng cố điều khiển thích nghi bền vững tác giả Nguyễn Tấn Lũy nghiên cứu [16], thử nghiệm thành công cho xe tự hành Trong luận án tiến sĩ tác giả Nguyễn Văn Tính [17] đề xuất sử dụng điều khiển thích nghi sử dụng mạng nơ ron để ước lượng thành phần nhiễu bất định trượt bánh xe, có nhiều cơng bố đáng nghi nhận 1.3.2 Tình hình nghiên cứu ngồi nước Trên giới, vài thập kỉ gần điều khiển xe tự hành quan tâm nghiên cứu phát triển rộng rãi, nhiều phương pháp từ điều khiển kinh điển tuyến tính hóa phản hồi, thiết kế dựa hàm Lyapunov; đến phương pháp điều khiển phi tuyến đại đề xuất áp dụng cho WMR, điều khiển trượt, điều khiển thích nghi, điều khiển thích nghi nơ-ron, mờ Với cấu trúc hai mạch vịng điều khiển: mạch vịng động học bên ngồi sử dụng hàm Lyapunov tổng hợp điều khiển bám vị trí, mạch vòng động lực học bên điều khiển bám tốc độ Nhiều phương pháp điều khiển mạch vòng động lực học đề xuất điều khiển trượt [18-22]; điều khiển Backstepping [23] Khi phương trình động lực học có tham số bất định điều khiển thích nghi đưa vào thiết kế [24-27], điều khiển thích nghi kết hợp với nơ ron để xấp xỉ thành phần bất định trước [14, 28-30], điều khiển thích nghi kết hợp với logic mờ [31-35] cho chất lượng điều khiển tốt, bù sai lệch mơ hình nhiễu đầu vào hệ thống Giải pháp sử dụng quan sát nhiễu đề xuất sử dụng tài liệu [36] tác giả D Huang cộng sự, dùng quan sát nhiễu với lọc Kalman mở rộng tác giả L Li [37] Năm 2008, hai tác giả Danwei Wang Chang Boon Low người nghiên cứu đưa ma sát trượt bánh vào mơ hình hóa xe tự hành Thành phần ma sát trượt bánh ơng đưa vào mơ hình động học, động lực học xe [38], sau ơng thiết kế xe điều khiển bám dựa định vị GPS [39] Ma sát trượt bánh xuất loại WMR làm ảnh hưởng tiêu cực đến tốc độ vị trí xe, để khắc phục tình trạng thực cách bù trực tiếp thông qua thiết bị đo để xác định ước lượng giá trị vận tốc gia tốc trượt [40, 41] Cách khác sử dụng giải pháp bù gián tiếp thông qua điều khiển, cách phổ biến có nhiều cơng bố nghiên cứu đề xuất giải pháp điều khiển, phải kể đến hàng loạt nghiên cứu tác giả S Yoo [26-28, 42-44] số tác giả khác M Chen [45], [29] giải pháp điều khiển thích nơ-ron dựa việc học tăng cường để xấp xỉ thành phần ma sát trượt không xác định cách trực tiếp Sử dụng ước lượng nhiễu để ước lượng bù ma sát trượt bánh [46] 1.4 Kết luận chương Trong chương 1, luận án trình bày mơ hình hệ thiếu cấu chấp hành nói chung WMR nói riêng Xây dựng mơ hình WMR xe di chuyển điều kiện thường, xe chuyển động với tốc độ nhanh mặt sàn trơn ướt có tính đến ma sát trượt bánh tác động vào mơ hình động học, động lực học xe Nghiên cứu tình hình tổng quan phương pháp điều khiển nước cơng bố Phân nhóm phương pháp điều khiển xe tự hành, phân tích đánh giá ưu nhược điểm phương pháp để đề xuất hướng nghiên cứu CHƯƠNG TỔNG HỢP BỘ ĐIỂU KHIỂN TRƯỢT TẦNG BACKSTEPPING CHỈNH ĐỊNH MỜ CẤU TRÚC MỘT MẠCH VÒNG 2.1 Cơ sở lý thuyết điều khiển trượt tầng backstepping Mơ hình động lực học WMR thiếu cấu chấp hành, Nghiên cứu sinh đề xuất sử dụng điều khiển trượt tầng để điều khiển tọa độ vị trí xe kĩ thuật Backstepping thiết kế điều khiển góc hướng dựa hàm điều khiển Lyapunov Điều khiển trượt phương pháp thiết kế phù hợp cho hệ thiếu cấu chấp hành Điều khiển trượt tầng ứng dụng cho đối tượng phân chia thành hệ con, sau định nghĩa mặt trượt cho hệ Từ mặt trượt tổng hợp lên mặt trượt chung cho hệ Kỹ thuật Backstepping cơng cụ xác định tín hiệu điều khiển dựa hàm điều khiển Lyapunov, áp dụng cho hệ phi tuyến truyền ngược 2.2 Tổng hợp điều khiển trượt tầng backstepping cho xe tự hành ba bánh Mơ hình động lực học WMR: x m sin b1u1 cos (2.47) y cos b1u1 sin m b2u2 Trong đó: b1 ; u ,u ,b b rm rI R L R L Điều khiển xe bám quỹ đạo đặt trước, ta định nghĩa vector sai số bám quỹ đạo: e q qr ex , ey , e x xr , y yr , r (2.48) Với q r quỹ đạo mong muốn Mô hình (2.47) tách thành hai hệ Hệ thứ cịn phụ thuộc vào tín hiệu điều khiển u1 hệ thứ hai phụ thuộc vào tín hiệu điều khiển u2 Bộ điều khiển bám quĩ đạo cho WMR bao gồm hai thành phần: điều khiển trượt tầng để tổng hợp tín hiệu điều khiển u1 điều khiển backstepping cho tín hiệu điều khiển u2 Nội dung trình bày bước tổng hợp điều khiển 2.2.1 Xây dựng điều khiển bám trượt tầng cho xe bám vị trí T T Mơ hình khơng gian trạng thái biến x, y (2.47) đưa dạng mơ hình sai lệch vị trí: e1 ex ex f1 ( x ) g1 ( x )u1 xr (2.51) e e y e y f ( x ) g ( x )u1 yr Trong đó: sin ; f ( x ) cos ; m m g1 ( x ) b1 cos ; g ( x ) b1 sin Ta định nghĩa mặt trượt thứ nhất: S1 c1e1 ex Chọn tín hiệu điều khiển: c e f ( x ) k1S1 1 sgn S1 xr u1 1 g1 ( x ) g1 ( x ) f1 ( x ) ueq11 (2.52) (2.57) usw11 Để có được: S1 c1e1 ex c1ex f1 ( x) g1 ( x)u1 xr k1S1 1 sgn S1 Ta định nghĩa mặt trượt thứ 2: S2 1S1 1s2 1S1 1 (c2 e3 e y ) (2.56) (2.53) s2 Tương tự chọn tín hiệu điều khiển u1 giống bước trên, để giảm tượng chattering tần số cao, hàm dấu sgn S thay hàm satS2 : 1 f1 ( x ) 1 f ( x ) 1c1ex 1c2 e y 1 xr 1 yr 2 sat ( S ) k2 S u1 1 g1 ( x ) 1 g ( x ) (2.65) 2.2.2 Bộ điều khiển bám Backstepping cho góc hướng Xét hệ thứ từ mơ hình (2.47): b2u2 (2.66) Nhiệm vụ đặt thiết kế tín hiệu điều khiển u2 để tín hiệu đầu góc hướng bám theo góc hướng đặt r Các bước tổng hợp tín hiệu điều khiển trình bày chi tiết trang 35-36 luận án, tín hiệu điều khiển u2 là: u2 ( z1 a2 z2 1 ) (2.80) b2 Trong số: a1 0, a2 2.2.3 Phát biểu định lý chứng minh tính ổn định hệ kín Bộ điều khiển cho hệ thống là: T T u1 u2 u2 u1 (2.82) τ R L Phát biểu: Hệ thống có mơ hình (2.47), với điều khiển trượt tầng backstepping (2.82), với u1 , u2 phương trình (2.63), (2.80) hệ kín ổn định tiệm cận Chứng minh tính ổn định trình bày trang 39 luận án 2.3 Tổng hợp điều khiển trượt tầng backstepping chỉnh định mờ cho xe tự hành ba bánh Hình 2.5: Sơ đồ cấu trúc hệ điều khiển trượt tầng backstepping chỉnh định mờ 10 Phần bổ sung thêm mờ để chỉnh định tham số c1 , c2 , với mục đích xác định tham số phù hợp điều khiển trượt theo thay đổi sai lệch đạo hàm sai lệch vị trí, sơ đồ cấu trúc điều khiển Hình 2.5 2.4 Mơ kiểm chứng Kết mơ điều khiển trượt tầng backstepping có chỉnh định mờ khơng có chỉnh định mờ với quy ước BHSMC điều khiển trượt tầng backstepping, AFBHSMC điều khiển trượt tầng backstepping chỉnh định mờ Kiểm chứng với quỹ đạo đặt hình trịn, khơng có nhiễu có nhiễu tác động trình bày Hình 2.11 Hình 2.13, kết cho thấy hệ ổn định, quỹ đạo xe bám quỹ đạo đặt, chất lượng bám tốt Hình 2.11: So sánh điều khiển bám quỹ đạo trịn, chưa có nhiễu Hình 2.13: So sánh điều khiển bám có nhiễu sin tác động 11 Kết luận chương Chương luận án trình bày sở phương pháp điều khiển trượt tầng, kĩ thuật backstepping, áp dụng tổng hợp điều khiển cho WMR dựa mô hình động lực học xe Đưa cấu trúc điều khiển sử dụng mạch vòng điều khiển, thuật toán điều khiển đơn giản, dễ thực thi Trong chương phát biểu định lý, chứng minh tính ổn định hệ kín Kết mô cho thấy sai số quỹ đạo tương đối nhỏ, chất lượng bám tốt Tuy vậy, hạn chế chương điều khiển đáp ứng tốt với tham số bất định ma trận qn tính, nhiễu ngồi tác động giới hạn phạm vi nhỏ Khi xe di chuyển tốc độ cao chuyển động trên mặt sàn trơn trượt ma sát bánh xe làm ảnh hưởng đến tốc độ vị trí xe, nhiễu lớn điều khiển khơng khắc phục Do đó, chương luận án nghiên cứu ứng dụng điều khiển thích nghi để giải vấn đề nhiễu môi trường tác động lên hệ thống cách hiệu CHƯƠNG TỔNG HỢP BỘ ĐIỂU KHIỂN THÍCH NGHI DỰA TRÊN ƯỚC LƯỢNG NHIỄU CẤU TRÚC HAI MẠCH VÒNG 3.1 Điều khiển thích nghi Điều khiển thích nghi thường hay ứng dụng hệ thống có tham số bất định, khơng xác định xác, tham số hệ thống bị thay đổi sau thời gian sử dụng, khơng có đủ thơng tin tham số Để giải tốn điều khiển bám cho WMR điều kiện có nhiễu mơi trường tác động, chương luận án đưa hai phương pháp điều khiển thích nghi tín hiệu, sử dụng ước lượng thành phần nhiễu Sử dụng cấu trúc truyền thống hai mạch vịng điều khiển 3.2 Điều khiển thích nghi ước lượng nhiễu vòng 3.2.1 Tổng hợp điều khiển động lực học Mơ hình động lực học xe xét đến thành phần bất định, nhiễu ngồi tác động ma sát, sai lệch mơ hình yếu tố khác là: v M 1E (τ τ d ) (3.4) Với τ d - coi thành phần nhiễu bất định hệ 12 Chọn tín hiệu điều khiển cho mạch vòng trong: τ B1 ( Kev vc ) τ d Thì ta có mơ hình vịng là: ev Kev τ d τ d (3.4) (3.5) Chọn K ma trận số xác định dương Nhìn vào phương trình (3.4 ta thấy, thành phần ước lượng τ d τ d lim ev t , sai t lệch tốc độ khơng, đảm bảo tính ổn định cho mạch vịng Với τ d giá trị ước lượng thành phần nhiễu τ d , nguyên tắc ước lượng trình bày chi tiết trang 48 49, cơng thức tính sau: τ dk (Ts BT B)1 BT (vk 1 zk 1 ) (3.11) 3.2.2 Tổng hợp điều khiển động học Phương trình sai số quỹ đạo: e1 cos sin 0 xr x eq e2 sin cos 0 yr y e3 0 r Lấy đạo hàm cấp phương trình (3.12) ta có: r cos e3 1 e2 eq r sin e3 e1 r 1 (3.12) (3.16) Tín hiệu điều khiển chọn để thỏa mãn hàm Lyapunov là: r cos e3 k1e1 vc (3.19) r k2 vr e2 k3r sin e3 Tuy nhiên, thực tế, xe di chuyển địa hình phức tạp xảy tượng trượt bánh làm ảnh hưởng lớn tới tính ổn định chất lượng hệ thống Phần bổ sung thuật tốn điều khiển có khả bù trượt bánh, thành phần bất định, nhiễu tác động 3.3 Tổng hợp điều khiển thích nghi ước lượng nhiễu mạch vịng ngồi Mục 3.3 trình bày phương pháp điều khiển thích nghi dựa sở ước lượng nhiễu (Non-linear Disturbance Observer- based13 NDOB), có khả bù ảnh hưởng tượng trượt bánh xe, nhiễu tác động lên hai mạch vòng động lực học động học 3.3.1 Cơ sở phương pháp luận Xét hệ phi tuyến có nhiễu tác động mô tả sau: x f ( x ) g ( x )u d (3.21) y h( x ) Với hệ (3.21), thành phần bất định d chưa biết cần phải ước lượng Gọi dˆ giá trị ước lượng nhiễu d z biến trạng thái bên khối ước lượng, phương pháp NDOB đại lượng dˆ xác định sau: dˆ z p( x ) (3.22) z L( x ) z L( x ) p( x ) f ( x ) g ( x )u Trong đó: p( x) hàm phi tuyến thiết kế với hệ số phi tuyến L( x ) định nghĩa là: L( x ) p( x ) x (3.23) Đại lượng nhiễu d giả thiết biến đổi chậm Khi đó, để dˆ tiến dần đến d , tức sai lệch ước lượng ed d dˆ tiến khơng phương trình sau phải thỏa mãn với ed : e d L ( x )e d (3.24) Tức cần phải có L( x ) xác định dương, ta chọn p( x) cho L( x ) dương Với giá trị ước lượng nhiễu dˆ (3.22), luật điều khiển cho hệ (3.21) chọn có dạng tổng quát sau: (3.25) u α( x ) β ( x )dˆ Trong đó: thành phần α( x ) luật điều khiển phản hồi chưa xét đến nhiễu Thành phần β ( x) thiết kế để bù nhiễu Chọn thành phần β ( x) là: β ( x ) g ( x ) 1 (3.28) 14 Nhiệm vụ α( x ) đưa sai lệch tĩnh hệ e x xd , x d tín hiệu đặt, ta chọn: α( x) g 1 ( x)[ f ( x) xd Ce] (3.31) 3.3.2 Tổng hợp điều khiển cho mạch vòng động lực học Mơ hình động lực học xe: v (M 21B(v))v M 21τ d1 (3.33) Đặt sai lệch: ev v vd , v d là giá trị đặt tốc độ vòng Đạo hàm hai vế (3.33) theo thời gian đặt thành phần bất định cần ước lượng d1 vd M 21Bvd M 21 (Q C G τ d ) , ta có: ev M 21Bev M 21τ d1 1 1 (3.35) viết gọn (3.35) thành: Đặt f (ev ) M Bev ; g(ev ) M ev f (ev ) g (ev )τ d1 (3.36) Ta nhận thấy mô hình (3.36) có dạng giống hệ (3.21), tiến hành tổng hợp điều khiển dựa sở phương pháp luận trình bày mục 3.1, ta có luật điều khiển cho mạch vòng là: (3.34) τ ( B M 2C1 )ev M dˆ1 Trong đó: C số xác định dương, dˆ đại lượng ước lượng 1 nhiễu d1 , tính sau: dˆ1 z1 L1ev 1 1 z1 L1 z1 L1 ( L1ev M Bev M τ ) (3.38) 3.3.3 Tổng hợp điều khiển cho mạch vịng động học Hình 3.3: Xe tự hành bám mục tiêu Z 15 Mục tiêu điều khiển WMR theo mục tiêu quỹ đạo cho trước, gọi điểm mục tiêu di chuyển xe Z ( xZ , yZ ) , sai lệch vị trí điểm hai bánh xe (điểm M) với điểm mục tiêu Z hệ tọa độ OXY Hình 3.3 e p Phương trình sai lệch vị trí: ex cos sin xZ ep hu p d e y sin cos yZ (3.46) Luật điều khiển u p cho (3.46) tách thành hai thành phần u p1 u p , u p1 tín hiệu bù nhiễu cho thành phần phi tuyến mơ hình, u p tín hiệu điều khiển phản hồi: u p u p1 u p (3.47) Chọn: cos sin xZ u p1 h1 sin cos yZ Thay (3.47), (3.48) vào (3.46) được: e p hu p d (3.48) (3.49) Áp dụng phương pháp thiết kế NDOB, điều khiển vịng ngồi là: up h1C2e p h1dˆ2 (3.50) Thành phần ước lượng nhiễu dˆ2 dˆ2 z2 L2 e p ; z2 L2 z2 L2 ( L2 e p hv p ) (3.51) Hình 3.4: Sơ đồ khối hệ thống điều khiển thích nghi ước lượng nhiễu mạch vòng điều khiển 16 Phần chứng minh tính ổn định mạch vịng điều khiển trình bày trang 59-61 luận án 3.4 Mơ kiểm chứng 3.4.1 Mô với cấu trúc điều khiển thích nghi ước lượng vịng T q cos 0.125 t ,sin 0.125 t , 0.125 t Với quỹ đạo đặt là: r điểm ban đầu: q0 x0 , y0 ,0 1,0, / 2 Nhận xét: Hình 3.5 cho thấy đường đặc tính quỹ đạo xe nằm chồng kín lên đặc tính quỹ đạo đặt, xe di chuyển bám sát với quỹ đạo đặt trước Thành phần nhiễu đầu vào nhận dạng với tốc độ nhanh, gần độ xác cao T T Hình 3.5: Xe bám quỹ đạo đặt hình trịn 3.4.2 Kết mơ điều khiển thích nghi ước lượng nhiễu mạch vịng Xét thành phần trượt dọc trục ngang trục tác động vào xe là: R , L , 1 sin(t ),1 cos(t ),sin(t ) T T Mô để kiểm chứng luật điều khiển mục tiêu Z di chuyển theo quỹ đạo đặt: xZ (t ) cos(0.2t ) yZ (t ) 3sin(0.2t ) 17 Kết mô cho thấy với điều khiển thiết kế trên, từ điểm xuất phát ngồi quỹ đạo đặt trước xe tiến ln quỹ đạo đặt bám sát quỹ đạo đặt Hình 3.9: Quỹ đạo bám xe Trong Hình 3.9, so sánh quỹ đạo xe di chuyển luật điều khiển luận án ( đường nét liền) với phương pháp điều khiển trượt tài liệu [46] (đường nét đứt dài), bám theo quỹ đạo đặt (đường nét đứt ngắn), thấy điều khiển sử dụng luận án đề xuất cho chất lượng bám nhanh xác hơn, điều cịn thể rõ đường đặc tính sai số vị trí, sai số tốc độ trang 65, 66 luận án 3.5 Kết luận chương Chương sử dụng cấu trúc hai mạch vòng điều khiển, luận án đề xuất hai phương pháp ước lượng nhiễu Một thiết kế ước lượng nhiễu dựa nguyên tắc tối ưu đoạn áp dụng cho mạch vòng động lực học để loại bỏ thành phần nhiễu đầu vào Hai thiết kế ước lượng nhiễu có khả loại bỏ ảnh hưởng thành phần nhiễu tác động vào mơ hình hệ thống, áp dụng cho hai mạch vòng động học động lực học Các kết thiết kế phân tích ổn định dựa tiêu chuẩn Lyapunov đánh giá mô kỹ thuật số Cả hai phương pháp điều khiển đề xuất chương dựa cấu trúc thích nghi trực tiếp, tức tín hiệu điều khiển gồm thành phần lấy từ điều khiển phản hồi thành phần thích nghi dựa quan sát nhiễu Các điều khiển thích nghi dựa 18 quan sát nhiễu có đặc điểm chung cồng kềnh Do đó, chương luận án đề xuất cấu trúc điều khiển sử dụng điều khiển thích nghi tham số, điều khiển mờ loại sử dụng để bù bất định nhiễu CHƯƠNG TỔNG HỢP BỘ ĐIỂU KHIỂN THÍCH NGHI MỜ LOẠI CẤU TRÚC HAI MẠCH VÒNG 4.1 Hệ mờ loại Cơ sở hệ mờ loại trình bày trang 68-71 luận án 4.2 Tổng hợp điều khiển điều khiển thích nghi mờ loại cho mạch vịng ngồi Khi xét đến ảnh hưởng tượng ma sát trượt bánh xe thành phần nhiễu ngồi tác động lên xe tự hành, mơ hình động học động lực học đưa dạng tổng quát: x F ( x) x G( x)u d , với u vector tín hiệu đầu vào d thành phần nhiễu Để xử lý thành phần nhiễu d trước, đề xuất sử dụng hệ logic mờ loại để thiết kế điều khiển cho WMR, kết hợp với điều khiển thích nghi để chỉnh định tham số đầu mờ Cấu trúc hệ thống điều khiển bao gồm hai mạch vịng kín 4.2.1 Thiết kế điều khiển mạch vịng động lực học Biểu diễn mơ hình động lực học theo biến sai lệch tốc độ: ev F (v ) G uv d vd (4.15) - Khi chưa xét đến thành phần nhiễu ( d ), chọn luật điều khiển: uv uv* G 1 F (v ) K1ev vd (4.16) Với K ma trận xác định dương Khi ta có: F (v) K1ev Guv* vd (4.17) Thay (4.16) vào (4.15) ta được: ev K1ev (4.18) - Khi xét đến thành phần nhiễu (d 0) , hàm F (v ) G chưa biết, luật điều khiển (4.16) khơng cịn xác Do đó, nhóm tác giả sử dụng điều khiển thích nghi mờ loại kết hợp thêm thành phần điều khiển bền vững H để giảm thiểu ảnh hưởng nhiễu sai số xấp xỉ điều khiển mờ, luật điều khiển sau: 19 uv uˆv (v | 1 ) G1us (4.19) T uˆv (v | 1 ) ξ1 1 đầu điều khiển thích nghi mờ loại 2, ξ1 diag (ξ1v ) , ξ1v 11 , 12 , 1i , , 1 , 1i tính theo cơng thức: f 1i 1i (4.20) f1l l 1 Với f1i độ thoả mãn mệnh đề điều kiện thứ i, số luật mờ Và us us1 us thành phần điều khiển bền vững H T Luật điều khiển us luật thích nghi 1 chọn sau: us B1T Pev (4.24) 1 ξ1T GB1T Pev (4.25) 4.2.2 Thiết kế điều khiển mạch vòng động học Phương trình động học hệ: ex cos sin xZ ep hu p d e y sin cos yZ (4.27) Luật điều khiển u p tách thành hai thành phần u p1 u p , u p1 chọn giống mục 3.3.2, u p tín hiệu điều khiển phản hồi, hệ đưa dạng: e p hu p d (4.30) Khi nhiễu loạn bên d , đề xuất luật điều khiển u p là: u p u*p h1 K e p (4.31) e p K2e p (4.32) Từ (4.32) cho thấy đảm bảo sai lệch lim e p t K t Tuy nhiên, xét đến thành phần nhiễu luật điều khiển (4.31) khơng cịn xác Do sử dụng điều khiển thích nghi mờ loại cho tín hiệu điều khiển u p sau: 20 t u p uˆ p (e p | 2 ) h1 (1e p e p dt ) (4.33) Trong 1 , số xác định dương; uˆ p (e p | 2 ) đầu điều khiển thích nghi mờ loại 2: uˆ p (e p | ) ζ 2T (4.34) Với ξ diag (ξ p ) , ξ p 21 , 22 , j , , , j tính theo cơng thức [74], với f1 j độ thoả mãn mệnh đề điều kiện thứ j thì: 2 j f2 j f k 1 (4.35) 2k Chọn hiệu điều khiển uk luật thích nghi sau: uk B2T e p 2 ξ hT B2 e p (4.40) (4.41) Hình 4.3: Sơ đồ khối cấu trúc hệ thống điều khiển 4.2.3 Chứng minh tính ổn định Chứng minh tính ổn định cho mạch vịng động lực học mạch vịng động học trình bày chi tiết luận án trang 76-78 4.3 Mô kiểm chứng Tiến hành mô điều khiển thích nghi mờ loại thiết kế cho hai mạch vòng điều khiển trên, đồng thời so sánh với trường hợp thay điều khiển thích nghi mờ loại điều khiển thích nghi mờ loại truyền thống Bộ mờ loại sử dụng hai hàm liên 21 thuộc dạng Gauss cho biến đầu vào Về thơng số mơ hình, ảnh hưởng nhiễu tác động độ trượt bánh xe sử dụng trường hợp giống Hình 4.5: Xe bám quỹ đạo trịn Hình 4.6: Sai số vị trí phương X sử dụng mờ loại loại Hình 4.7: Sai số vị trí phương Y sử dụng mờ loại loại Từ Hình 4.5 đến Hình 4.7 cho thấy chất lượng điều khiển thích nghi mờ loại xử lý nhiễu chống trượt tốt điều khiển thích nghi mờ loại 1, nhờ lợi việc chọn hàm thành viên dạng ống điều khiển mờ Khi có nhiễu ngồi trượt bánh quỹ đạo bám tốt 4.4 Kết luận chương Chương luận án trình bày phương pháp tổng hợp điều khiển thích nghi mờ loại cho cấu xe tự hành có xem xét đến ma sát trượt bánh, nhiễu môi trường tác động Tính ổn định hệ chứng minh lý thuyết kiểm chứng mô 22 KẾT LUẬN CHUNG CỦA LUẬN ÁN Kết luận: Luận án với đề tài: “Ứng dụng điều khiển thích nghi hệ thiếu cấu chấp hành cho xe tự hành ba bánh”, thực theo mục tiêu đặt Đó nghiên cứu cấu trúc điều khiển mới, phương pháp điều khiển đại áp dụng cho hệ thiếu cấu chấp hành có ràng buộc non-honomic, cụ thể cho WMR ba bánh Các cấu trúc phương pháp điều khiển cho WMR xây dựng dựa mơ hình tốn học đề xuất Các phương pháp điều khiển thích nghi xây dựng nhằm mục đích đảm bảo cho WMR bám quĩ đạo đặt trước, khắc phục sai lệch mơ hình, ma sát bánh xe nhiễu bên ngồi tác động vào Luận án có đóng góp trình bày chương 2,3 luận án: Đề xuất cấu trúc điều khiển sử dụng mạch vòng điều khiển thay cấu trúc hai mạch vịng điều khiển thơng thường cho WMR Ở cấu trúc điều khiển này, điều khiển trượt tầng backstepping thích nghi mờ thiết kế để đảm bảo xe bám quĩ đạo đặt với sai số tiến không trường hợp nhiễu tác động vào hệ thống có biên độ nhỏ Tính ổn định tiệm cận hệ thống phân tích dựa lý thuyết ổn định Lyapunov chất lượng hoạt động xe kiểm nghiệm thông qua mô kỹ thuật số Dựa cấu trúc hai mạch vòng truyền thống, đề xuất thuật tốn điều khiển thích nghi cho xe tự hành đảm bảo bám quĩ đạo đặt trước bù thành phần bất định, nhiễu ma sát trượt bánh xe, cụ thể là: - Thiết kế thuật tốn điều khiển thích nghi kết hợp ước lượng nhiễu cho WMR Bộ điều khiển đề xuất có khả bù thành phần bất định đảm bảo cho xe có chất lượng bám xác ổn định Tính ổn định vòng điều khiển gồm đối tượng, điều khiển, ước lượng phân tích dựa lý thuyết ổn định Lyapunov - Đề xuất điều khiển thích nghi bền vững cở sở hệ mờ bậc hai Bộ điều khiển bám thích nghi mờ đề xuất luận án có khả loại bỏ ảnh hưởng thành phần bất định mô hình nhiễu mơi trường cho WMR Tính ổn định 23 vòng điều khiển chứng minh tốn học thơng qua phương pháp Lyapunov Tính hợp lý đắn phương pháp điều khiển kiểm nghiệm thông qua mô với kịch mô khác quỹ đạo phức tạp, mơ hình bất định, hệ chịu ảnh hưởng tượng trượt bánh Các kết mô chứng minh cấu trúc điều khiển đề xuất hoạt động tốt điều kiện làm việc khác Hướng phát triển luận án: Với cấu trúc hai mạch vịng điều khiển, phần chứng minh tính ổn định dừng lại việc chứng minh cho mạch vịng ổn định, hệ kín hai mạch vịng phản hồi vấn đề tồn luận án Các kết luận án dừng lại phân tích lý thuyết khảo sát qua mô số Tuy cố gắng mô gần xác với đối tượng thực, để áp dụng cho WMR đòi hỏi phải thực thi cho xe thực tế Đó phần mà nghiên cứu sinh muốn tiếp tục thực thời gian tới Mặt khác, giả thiết dừng lại xe chuyển động mặt phẳng khơng có vật cản Những nghiên cứu để hoàn thiện thuật tốn điều khiển mơi trường chuyển động xe có vật cản động tĩnh, đề xuất hướng nghiên cứu luận án 24 ... thiếu cấu chấp hành Hệ thiếu cấu chấp hành hệ điều khiển có số thiết bị chấp hành số bậc tự số biến mơ hình, tức hệ có số bậc tự khơng cấu chấp hành tác động trực tiếp, biến phụ thuộc Các hệ thiếu. .. động Phạm vi nghi? ?n cứu xây dựng mô hình tốn học cho hệ xe ba bánh tự hành, từ đề xuất điều khiển bám trường hợp nhiễu tác động có biên độ nhỏ Ứng dụng điều khiển thích nghi cho xe tự hành bám quỹ... tiêu nghi? ?n cứu luận án nghi? ?n cứu mơ hình tốn học điều kiện làm việc xe ba bánh tự hành, từ ứng dụng điều khiển thích nghi phi tuyến, điều khiển thích nghi mờ để giải tốn bám quỹ đạo cho xe đạo