Chương 1 [9] HVTH: NGUYỄN VIỆT KHOA LUẬN VĂN THẠC SĨ GVHD: PGS. HUỲNH THÁI HOÀNG Chất lượng quỹ đạo trong kết quả này phụ thuộc vào quần thể ban đầu, quần thể ban đầu càng đông thì kết quả tính toán sau cùng càng tốt, càng tối ưu. Tiêu chuẩn tối ưu là chọn đường ngắn nhất. Phƣơng pháp dùng đƣờng cong 3 spline bậc 7 kết hợp với GA Đây cũng là phương pháp hoạch định quỹ đạo mới dùng đường cong 3 spline bậc 7 theo [14].
Việc tính toán các hệ số làm sao để đường cong đủ trơn và ngắn để robot bám theo mà không bị rung lắc và đến đích an toàn. Theo kết quả [14] các hệ số được tính toán tối ưu dùng giải thuật GA và cho kết quả khả quan, mặc khác bản thân đường cong 3 spline bậc 7 cũng đã tối ưu phần nào quỹ đạo. Tổng quát quỹ đạo đường cong 3 spline (G3) bậc 7 p u u u , u 0, 1 được tính như sau: T u 0 1s 2 s 2 3s3 4 s 4 5 s5 6 s 6 7 s 7 (1.2) Trong đó: u 0, 1 là tham số quãng đường đã được chuẩn hóa Các hệ số của đa thức được tính như sau: 0 xA (1.6) 2 2 4 35 xB xA 201 53 5 cos A 512 A 13 A 213 A sin A 3 3 5 1 5 1 1 152 4 6 cos B 22 B 23 B 24 B sin B 2 6 2 6 2 Chương 1 [10] HVTH: NGUYỄN VIỆT KHOA LUẬN VĂN THẠC SĨ GVHD: PGS. HUỲNH THÁI HOÀNG (1.7) 5 84 xB xA 451 103 5 cos A 1012 A 13 A 313 A sin A 1 1 3 392 74 6 cos B 722 B 23B 24 B sin B 2 2 2 (1.8) 15 2 6 70 xB x A 361 3 5 cos A 2 3 15 2 13 1 12 A 13 A 213 A sin A 34 2 4 6 cos B (1.9) 2 3 2 2 13 1 3 22 B 23 B 2 4 B sin B 2 2 2 1 7 20 xB x A 101 23 5 cos A 6 1 1 1 212 A 13 A 13 A sin A 10 2 2 4 6 cos B (1.14) 2 2 4 35 xB xA 201 53 5 sin A 512 A 13 A 213 A cos A 3 3 5 1 5 1 1 152 4 6 sin B 22 B 23 B 2 4 B cos B 2 6 2 6 2 (1.15) Chương 1 [11] HVTH: NGUYỄN VIỆT KHOA LUẬN VĂN THẠC SĨ GVHD: PGS.
HUỲNH THÁI HOÀNG 5 84 xB xA 451 103 5 sin A 1012 A 13 A 313 A cos A 1 1 3 392 74 6 sin B 722 B 23B 24 B cos B 2 2 2 (1.16) 15 2 6 70 yB y A 361 3 5 sin A 2 3 15 2 13 1 12 A 13 A 213 A cos A 34 2 4 6 sin B (1.17) 2 3 2 2 13 1 3 22 B 23 B 2 4 B cos B 2 2 2 1 7 20 yB y A 101 23 5 sin A 6 1 1 1 212 A 13 A 13 A cos A 10 2 2 4 6 sin B (1. Các hệ số tìm được kết hợp với GA Chương 1 [12] HVTH: NGUYỄN VIỆT KHOA LUẬN VĂN THẠC SĨ GVHD: PGS. HUỲNH THÁI HOÀNG Hình 1. Quỹ đạo sau tìm được dựa vào kỹ thuật Spline bậc 7 Hình 1.
Ứng dụng kỹ thuật Spline bậc 7 tính toán quỹ đạo tối ưu tìm vị trí hướng ra của không gian phòng cho robot di động Phƣơng pháp Limit Cycle (Chu kì giới hạn): Thuật toán limit cycle là một thuật toán mới trong việc định hướng và điều khiển cho robot tự hành, và được quan tâm nghiên cứu trong thời gian gần đây. Thuật toán này được áp dụng rất thành công trong lĩnh vực robot scoccer [7]. Tuy nhiên, lại khá mới mẻ trong lĩnh vực hoạch định quỹ đạo cho robot tự hành bằng Chương 1 [13] HVTH: NGUYỄN VIỆT KHOA LUẬN VĂN THẠC SĨ GVHD: PGS. HUỲNH THÁI HOÀNG bánh xe.
Hoạch định với limit cycle có thể được xếp vào nhóm phương pháp hoạch định theo trường thế năng. Trong việc hoạch định quỹ đạo, thuật toán sử dụng khung tham chiếu cụ thể để cung cấp chỉ dẫn chính xác về tình hình của robot cho phép robot có thể chọn hướng an toàn và thông suốt trong môi trường nhiều vật cản. Hơn nữa, nó tính toán được thời gian để robot đi vào quỹ đạo của các vật cản và thời điểm để đi ra khỏi vật cản. Những cách xử lý quỹ đạo này được thực hiện bằng cách thích nghi giới hạn chu kỳ của quỹ đạo.
Trong những trường hợp xung đột cụ thể, những bộ điều khiển con của limit cycle được kích hoạt để robot di chuyển không bị dao động, rơi vào bẫy cục bộ, hay có kết thúc chết hoặc bị kẹt một chỗ. Các bộ điều khiển con trong limit cycle được chứng minh ổn định theo tiêu chuẩn Lyapunov [6]. Cấu trúc điều khiển tổng quát của limit cycle cho phép giảm đáng kể thời gian robot chạy đến mục tiêu trong khi đang dự đoán và tránh vật cản. Kết quả mô phỏng trong nhiều môi trường khác nhau chứng minh độ tin cậy của cấu trúc điều khiển [3],[4],[5],[8].
Robot tránh vật cản bằng vòng ảo là vòng tròn Chương 1 [14] HVTH: NGUYỄN VIỆT KHOA LUẬN VĂN THẠC SĨ GVHD: PGS. HUỲNH THÁI HOÀNG Hình 1. Robot tránh vật cản bằng vòng ảo là ellipse 1.3 Lý do chọn đề tài Phương pháp limit cycle là một trong những phương pháp mới trong vấn đề thiết kế quỹ đạo di chuyển cho robot, với mong muốn quỹ đạo thu được là đường đi là tối ưu, trơn tru, dễ điều khiển và đến đích an toàn. Quỹ đạo sẽ hoạch định theo phương pháp limit cycle với vòng ảo bao vật cản là vòng tròn và ellipse.
Để quỹ đạo tối ưu cho robot di chuyển, các nhà nghiên cứu thường kết hợp với các thuật toán tính toán mềm như GA, PSO, Fuzzy, Neural,… để hoạch định quỹ đạo và đã có nhiều công trình thành công ứng dụng vào trong thực tiễn như robot dịch vụ chăm sóc con người PR2, xe lăn điện thông minh, robto lau nhà,…. Đây chính là lý do tác giả chọn hướng tiếp cận đề tài: “Thiết kế quỹ đạo tối ƣu và điều khiển robot di động” Chương 1 [15] HVTH: NGUYỄN VIỆT KHOA LUẬN VĂN THẠC SĨ GVHD: PGS. HUỲNH THÁI HOÀNG Vật cản Đích đến Limit Cycle Start Quỹ đạo Hình 1. Minh họa cho việc dùng các đường tròn chia nhỏ vật cản 1.4 Tính cấp thiết của đề tài Hoạch định quỹ đạo là bài toán rộng trong nhiều lĩnh vực như hàng không vũ trụ, quân sự, y tế, robot dịch vụ,… đây là bài toán được các nhà khoa học quan tâm nhiều trong lĩnh vực robot di động nhằm mục đích đưa ra quỹ đạo tối ưu và giảm chi phí khi di chuyển đến vị trí mong muốn.
Kết quả bước đầu của phương pháp limit cycle với vòng ảo là vòng tròn và ellipse sẽ ứng dụng vào việc hoạch định quỹ đạo cho robot lau nhà, xe lăn thông minh cho người tàn tật, người già khi di chuyển trong nhà và bệnh viện hoặc trong các hệ thống UAV quân sự.5 Mục tiêu và giới hạn đề tài Nghiên cứu và xây dựng giải thuật thiết kế quỹ đạo cho robot di chuyển dùng kỹ thuật limit cycle với vòng ảo bao các vật cản rời rạc là vòng tròn và vòng ellipse để robot tránh các vật cản và an toàn đến đích. Quỹ đạo di chuyển của robot phải êm, tránh rung lắc và ổn định được chứng minh theo tiêu chuẩn Lyapunov. Xây dựng giải thuật để robot tránh bẫy cục bộ khi gặp vật cản là bức tường dài hoặc các vòng ảo bao vật cản giao nhau. Chương 1 [16] HVTH: NGUYỄN VIỆT KHOA LUẬN VĂN THẠC SĨ GVHD: PGS.
HUỲNH THÁI HOÀNG Xây dựng không gian cho robot hoạt động là căn hộ chung cư trên matlab và áp dụng thuật toán limit cycle vào thiết kế quỹ đạo di chuyển cho robot. Kết hợp giải thuật di truyền GA với thuật toán limit cycle để tìm quỹ đạo tối ưu cho robot di chuyển trong môi trường căn hộ chung cư. Xây dựng mô hình phần cứng để điều khiển robot di chuyển theo quỹ đạo hoạch định trong môi trường toàn cục.6 Sơ lƣợc nội dung luận văn Cấu trúc luận văn gồm 5 chương Chƣơng 1: Tổng quan Nội dung của chương này giới thiệu về lĩnh vực robot di động, trình bày các phương pháp hoạch định quỹ đạo cho robot di động tự hành bằng bánh xe và các công trình liên quan từ đó đưa ra lý do chọn đề tài, tính cấp thiết và mục tiêu đề tài. Chƣơng 2: Cơ sơ lý thuyết Nội dung của chương này trình bày cơ sơ lý thuyết phương pháp limit cycle và giải thuật di truyền (GA).
Phương pháp tránh vật cản bằng các vòng ảo là vòng tròn, đồng thời phân biệt 4 vùng xung quanh vật cản khi robot di chuyển tránh vật cản.