BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC SƯ PHẠM KỸ THUẬT THÀNH PHỐ HỒ CHÍ MINH LUẬN VĂN THẠC SĨ CHÂU QUANG HẢI ROBOT TỰ HÀNH SỬ DỤNG CẢM BIẾN LASER 2D NGÀNH: KỸ THUẬT ĐIỆN TỬ - 605270 S KC 0 0 4 1 8 0 Tp. Hồ Chí Minh, tháng 04 năm 2014 Luan van BỘ GIÁO DỤC VÀ ĐÀO TẠO TRƯỜNG ĐẠI HỌC SƯ PHẠM KỸ THUẬT THÀNH PHỐ HỒ CHÍ MINH LUẬN VĂN THẠC SĨ CHÂU QUANG HẢI ROBOT TỰ HÀNH SỬ DỤNG CẢM BIẾN LASER 2D NGÀNH: KỸ THUẬT ĐIỆN TỬ MÃ NGÀNH: 60 52 70 Hướng dẫn khoa học: TS. NGÔ VĂN THUYÊN TP. Hồ Chí Minh, 04/2014 Luan van LÝ LỊCH KHOA HỌC I.
LÝ LỊCH SƠ LƢỢC Họ & tên: CHÂU QUANG HẢI Giới tính: Nam Ngày, tháng, năm sinh: 23/04/1986 Nơi sinh: Quảng Ngãi Quê quán: Thị xã Quảng Ngãi-Quãng Ngãi Dân tộc: Kinh Chức vụ, đơn vị công tác trƣớc khi học tập, nghiên cứu: Kỹ sƣ quy trình sản xuất tại công ty trách nhiệm hữu hạn Jabil VietNam. Chỗ ở riêng hoặc địa chỉ liên lạc: Thôn 1, xã Nghĩa Dũng, Thành Phố Quãng Ngãi, Tỉnh Quãng Ngãi. Điện thoại cơ quan: 0837332030 Điện thoại riêng: 0976404628 Fax: E-mail: chauquanghaispkt@gmail. QUÁ TRÌNH ĐÀO TẠO 1.
Đại học: Hệ đào tạo: chính quy Thời gian đào tạo từ 09/2005 đến 03/2010 Nơi học (trƣờng, thành phố): Đại Học Sƣ Phạm Kỹ Thuật TP, HCM. Ngành học: Điện Tử. Tên đồ án, luận án hoặc môn thi tốt nghiệp: ĐIỀU KHIỂN & GIÁM SÁT CÁC LOẠI PLC DÙNG CHUẨN OPC Ngày & nơi bảo vệ đồ án, luận án hoặc thi tốt nghiệp: Tháng 12 năm 2009 tại trƣờng Đại Học Sƣ Phạm Kỹ Thuật TP. Ngƣời hƣớng dẫn: Ths.
Tạ Văn Phƣơng. Thạc sĩ: Hệ đào tạo: chính quy Thời gian đào tạo từ 08/2011 đến 04/2014 Nơi học (trƣờng, thành phố): Đại Học Sƣ Phạm Kỹ Thuật Tp. Hồ Chí Minh. Ngành học: Kỹ Thuật Điện Tử.
Tên luận văn: Robot Tự Hành Sử Dụng Cảm Biến Laser 2D. i Luan van Ngày & nơi bảo vệ luận văn: Tháng 04 năm 2014, Đại Học Sƣ Phạm Kỹ Thuật Tp. Hồ Chí Minh. Ngƣời hƣớng dẫn: Ts.
Trình độ ngoại ngữ: tiếng Anh - Trình độ: B III. QUÁ TRÌNH CÔNG TÁC CHUYÊN MÔN KỂ TỪ KHI TỐT NGHIỆP ĐẠI HỌC Thời gian Nơi công tác Công việc đảm nhận 03/2010 đến nay Công ty trách nhiệm hữu hạn Jabil Kỹ sƣ quy trình sản xuất VietNam. ii Luan van LỜI CAM ĐOAN Tôi cam đoan đây là công trình nghiên cứu của tôi. Các số liệu, kết quả nêu trong luận văn phản ánh trung thực nội dung và quá trình nghiên cứu của luận văn.
Hồ Chí Minh, ngày 28 tháng 02 năm 2014 (Ký tên và ghi rõ họ tên) Châu Quang Hải iii Luan van LỜI CẢM TẠ Trong suốt quá trình thực hiện đề tài, ngƣời thực hiện đã đƣợc sự hƣớng dẫn tận tình của TS. Ngô Văn Thuyên – Phó Hiệu Trƣởng Trƣờng Đại Học Sƣ Phạm Kỹ Thuật TP HCM, giảng viên trƣờng Đại Học Sƣ Phạm Kỹ Thuật tp. Hồ Chí Minh. Dƣới sự hƣớng dẫn của Thầy, đề tài đã đƣợc nghiên cứu và hoàn thành đúng thời hạn cũng nhƣ mục tiêu đề ra ban đầu.
Ngƣời thực hiện xin gửi lòng tri ân sâu sắc đến TS. Ngô Văn Thuyên vì những kiến thức quý báu và các phƣơng pháp nghiên cứu mà thầy đã truyền dạy. Ngƣời thực hiện gửi lòng tri ân đến quý thầy cô trƣờng Đại Học Sƣ Phạm Kỹ Thuật tp. Hồ Chí Minh, quý thầy cô trƣờng Đại Học Bách Khoa tp.
Hồ Chí Minh đã tận tình hƣớng dẫn và truyền đạt những kiến thức, phƣơng pháp nghiên cứu và các kinh nghiệm trong suốt hai năm học. Những kiến thức và kinh nghiệm này chính là nền tảng giúp ngƣời thực hiện hoàn thành tốt luận văn này. Ngƣời thực hiện chân thành cảm ơn quý anh chị, chân thành cảm ơn bạn bè và ngƣời thân đã tận tình giúp đỡ trong suốt khóa học cũng nhƣ trong quá trình thực hiện luận văn. Hồ Chí Minh, ngày 28 tháng 02 năm 2014 Ngƣời thực hiện Châu Quang Hải iv Luan van NHẬN XÉT CỦA GIÁO VIÊN HƢỚNG DẪN.
HCM, ngày tháng năm 2014 TS. NGÔ VĂN THUYÊN v Luan van NHẬN XÉT CỦA CHỦ NHIỆM NGÀNH. HCM, ngày tháng năm 2014 TRẦN THU HÀ vi Luan van NHẬN XÉT CỦA GIÁO VIÊN PHẢN BIỆN. TP HCM, ngày tháng năm 2014 vii Luan van NHẬN XÉT CỦA HỘI ĐỒNG BẢO VỆ LUẬN VĂN.
TP HCM, ngày tháng năm 2014 viii Luan van TÓM TẮT Robot tự hành là một trong những bài toán quan trọng về việc robot tìm ra một đƣờng đi từ điểm bắt đầu đến điểm kết thúc mà không va chạm với vật cản thông qua dữ liệu từ cảm biến. Có rất nhiều phƣơng pháp hoạch định đƣờng đi cho robot tự hành đã đƣợc triển khai nhƣ: phƣơng pháp trƣờng thế năng (Potential Field), phƣơng pháp bản đồ đƣờng (Road Map), phƣơng pháp thuật toán di truyền (Genetic Algorithms),…nhƣng có khuyết điểm các phƣơng pháp trên là bị bẫy cực tiểu cục bộ (phƣơng pháp trƣờng thế năng), do đó đề tài sử dụng phƣơng pháp hoạch trƣờng thế năng kết hợp giữa thuật toán tìm đƣờng đi D* cho kết quả tránh đƣợc bẫy cực tiểu cục bộ. Trong các phƣơng pháp trên thì robot cần biết truớc vị trí ban đầu, vậy vấn đề đặt ra là rôbot chƣa biết vị trí thì làm thế nào ? Với đề tài của Ths Lâm Văn Vũ đã nghiên cứu đƣợc robot tự hành sử dụng cảm biến sonar [1], nhƣng robot tự hành thì chúng ta phải khai báo tọa độ ban đầu, vậy làm thế nào robot đến đích nếu không biết tọa độ ban đầu ? Do đó vấn đề định vị đựơc đƣa ra, trong quá trình hoạt động, các cảm biến của robot sẽ bị ảnh hƣởng bởi nhiễu từ môi trƣờng bên ngoài lẫn bên trong cơ cấu chấp hành của nó. Điều này có nghĩa là thông tin nhận đƣợc từ cảm biến không còn chính xác và có thể làm cho robot không đến đƣợc mục tiêu đã đề ra.
Do đó, robot phải thực hiện việc định vị liên tục trong quá trình di chuyển để xác định đúng vị trí của nó trong môi trƣờng và đƣa ra sự điều chỉnh hợp lý nhằm đạt kết quả mong muốn. Đề tài chọn phƣơng pháp định vị Monte Carlo (MCL – Monte Carlo Localization) bởi tính đơn giản và hiệu quả của nó khi thực hiện. MCL có khả năng định vị tốt ngay cả khi robot không đƣợc cho biết trƣớc vị trí ban đầu. Khi thực hiện, robot cần đƣợc trang bị một hệ thống cảm biến (thƣờng là cảm biến đo khoảng cách và hành trình).
Các thuật toán trong đề tài đƣợc viết bằng ngôn ngữ C++ và mô phỏng trên phần mềm Player/Stage. Kết quả mô phỏng cho thấy các thuật toán hoạt động rất tốt. Robot có thể đến đƣợc điểm mục tiêu cho trƣớc ngay cả khi không đƣợc cho biết trƣớc vị trí ban đầu. ix Luan van ABSTRACT Autonomous robot is one of the important problems of the robot to find a path from start point to end point without colliding with obstacles through data from the sensor.
There are many methods of path planning for autonomous robot has been implemented , such as the potential method ( Potential Field ), the road map method ( Road Map), genetic algorithm methods ( Genetic Algorithms ), cons. but there are methods that are trapped in local minima ( potential field method ), so that this thesis was planning to use the potential method to combine D* search path algorithm for results to avoid local minima traps. In the above methods, the robot need to know the initial coordinate, so the question is how is the robotic location unknown? With the thesis of Van Vu Lam MA has studied the autonomous robot using sonar sensors [ 1 ], but autonomous robot, we must declare the original coordinates, so how robots going to the goal without knowing the initial coordinate? Therefore the localization problem is made, in the course of operation; the sensor of the robot will be affected by noise from the outside and inside environment of actuator. This means that the information received from the sensor is no longer accurate and can make the robot does not reach the set goals.
Therefore, the localization of robot must perform continuous in the process of moving to define its place in the environment and make reasonable adjustments to achieve the desired results. This thesis chosen for the Monte Carlo method (MCL - Monte Carlo Localization) for its simplicity and its effectiveness when implemented. MCL has a good ability to localize even when the robot is not known in advance to its initial position. When performing, the robot should be equipped with a sensor system (usually sensors measure the distance and journey).
The algorithm in this thesis is written in C++ and Player/Stage simulation software. The simulation results show that the algorithm works very well. Robots can reach a given target point even it didn’t know the initial coordinate. x Luan van MỤC LỤC LÝ LỊCH KHOA HỌC.
i LỜI CAM ĐOAN. iii LỜI CẢM TẠ. iv NHẬN XÉT CỦA GIÁO VIÊN HƢỚNG DẪN. v NHẬN XÉT CỦA CHỦ NHIỆM NGÀNH.
vi NHẬN XÉT CỦA GIÁO VIÊN PHẢN BIỆN .vii NHẬN XÉT CỦA HỘI ĐỒNG BẢO VỆ LUẬN VĂN. ix DANH SÁCH CÁC HÌNH. xiii DANH SÁCH CÁC BẢNG. xv Chƣơng 1 Giới Thiệu .2 Mục tiêu và giới hạn đề tài .3 Nội dung đề tài.
4 Chƣơng 2 Cơ Sở Lý Thuyết .1 Cảm biến laser đo khoảng cách .2 Mô tả mô hình toán học của một số robot di động .3 Vấn đề định vị cho robot tự hành .1 Bài toán định vị .2 Phân bố Gauss và Bộ lọc Bayes .3 Các mô hình của bộ lọc Bayes .4 Các phƣơng pháp đinh vị xác suất. 23 Chƣơng 3 Lặp kế hoạch đƣờng đi và Ứng dụng của MCL trong robot tự hành33 xi Luan van 3.1 Lập kế hoạch đƣờng đi .3 Phƣơng Pháp Tránh vật cản bằng Trƣờng Thế Năng (Potential Field) .2 Ứng dụng của MCL trong robot tự hành.1 Thuật toán MCL.2 Mô hình vận động của robot .3 Mô hình cảm biến của robot .4 Ứng dụng phƣơng pháp MCL trong điều khiển robot tự hành. 50 Chƣơng 4 Xây dựng mô hình và phân tích mô phỏng thiết kế .1 Phần mềm mô phỏng robot Player/Stage. Đặc điểm của Player.
Đặc điểm của Stage.2 Kết quả mô phỏng trên phần mềm Player/Stage. Mô phỏng đƣờng đi của robot dùng phƣơng pháp PF (Potential field). Mô phỏng đƣờng đi của robot dùng phƣơng pháp PF kết hợp với D*. Mô phỏng đƣờng đi của robot dùng phƣơng pháp MCL kết hợp PF & D*60 Chƣơng 5 .1 Kết quả đã nghiên cứu .2 Kết luận và hƣớng phát triển của đề tài .2 Hƣớng phát triển của đề tài.
65 Tài Liệu Tham Khảo. 66 xii Luan van DANH SÁCH CÁC HÌNH Hình 1.1 Một số loại robot tự hành. 1 Tạo mặt phẳng cắt ngang tại laser bằng gương quay trong cảm biến đo laser 2D. 2 Mặt phẳng tia laser với góc quét β .