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Ĩ VÕ CÔNG PHÁT NGHIÊN CỨU, ỨNG DỤNG CÔNG NGHỆ QUÉT LASER 2D TRONG ĐỊNH VỊ ROBOT TIẾP TÂN NGÀNH: KỸ THUẬT CƠ ĐIỆN TỬ - 60520114 S K C0 0 5 1 1 5 Tp. Hồ Chí Minh, tháng 3/2016 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Ĩ VÕ CÔNG PHÁT NGHIÊN CỨU, ỨNG DỤNG CÔNG NGHỆ QUÉT LASER 2D TRONG ĐỊNH VỊ ROBOT TIẾP TÂN NGÀNH: KỸ THUẬT CƠ ĐIỆN TỬ - 60520114 Tp. Hồ Chí Minh, tháng 3/2016 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Ĩ VÕ CÔNG PHÁT NGHIÊN CỨU, ỨNG DỤNG CÔNG NGHỆ QUÉT LASER 2D TRONG ĐỊNH VỊ ROBOT TIẾP TÂN NGÀNH: KỸ THUẬT CƠ ĐIỆN TỬ - 60520114 Hướng dẫn khoa học: PGS.TS NGUYỄN TRƯỜNG THỊNH Tp. Hồ Chí Minh, tháng 3/2016 Luan van LÝ LỊCH KHOA HỌC I.
LÝ LỊCH SƠ LƢỢC: Họ & tên: VÕ CÔNG PHÁT Giới tính: Nam Ngày, tháng, năm sinh: 06/07/1991 Nơi sinh: Long An Quê quán: Cần Đƣớc – Long An Dân tộc: Kinh Chỗ ở riêng hoặc địa chỉ liên lạc: 25 Ngô Quyền, P. Hiệp Phú, Q9, TpHCM Điện thoại cơ quan: Điện thoại nhà riêng: Fax: E-mail: vophat0607@gmail. QUÁ TRÌNH ĐÀO TẠO: 1. Trung học chuyên nghiệp: Hệ đào tạo: Thời gian đào tạo từ ……/…… đến ……/ …… Nơi học (trƣờng, thành phố): Ngành học: 2.
Đại học: Hệ đào tạo: Chính quy Thời gian đào tạo từ 09/2009 đến 09/2013 Nơi học (trƣờng, thành phố): Trƣờng Đại học Sƣ Phạm Kỹ Thuật Tp HCM Ngành học: Kỹ thuật Điện-Điện tử Tên đồ án, luận án hoặc môn thi tốt nghiệp: NGHIÊN CỨU VÀ XÂY DỰNG MÔ HÌNH HỆ THỐNG MẠNG THEO CHUẨN XBEE TRONG ĐIỀU KHIỂN VÀ GIÁM SÁT Ngày & nơi bảo vệ đồ án, luận án hoặc thi tốt nghiệp: ngày 20/07/2013 tại Trƣờng Đại học Sƣ Phạm Kỹ Thuật TpHCM Ngƣời hƣớng dẫn: ThS. Trƣơng Ngọc Anh 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 nhiệm Cty TNHH Daewoo Royal 5/2013 – 8/2015 Kỹ thuật viên System (Việt Nam) 9/2015 – đến Trƣờng Cao Đẳng Công Nghệ Giảng viên nay Thủ Đức i 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 là trung thực và chƣa từng đƣợc ai công bố trong bất kỳ công trình nào khác Tp.
Hồ Chí Minh, ngày … tháng … năm 201… (Ký tên và ghi rõ họ tên) Võ Công Phát ii Luan van CẢM TẠ Lời đầu tiên tôi xin gửi lời cảm ơn đến tất cả quý thầy cô giảng dạy tại Trường Đại Học Sư Phạm Kỹ Thuật Thành Phố Hồ Chí Minh, đặc biệt là quý thầy cô khoa Cơ Khí Máy và khoa Điện Điện tử đã hướng dẫn và giảng dạy những kiến thức bổ ích tạo tiền đề vựng vàn và quan trọng cho tôi thực hiện chuyên đề này. Tôi xin gửi lời cảm ơn chân thành nhất đến giáo viên hướng dẫn thầy Nguyễn Trường Thịnh đã tận tình góp ý cũng như hướng dẫn chỉ bảo, cung cấp các kiến thức và vật tư quan trọng giúp tôi có nhiều điều kiện thuận lợi trong suốt quá trình thực hiện luận văn. Cảm ơn bạn bè, các anh chị em, những người đi trước và người thân đã góp ý kiến, giúp đỡ và động viên tôi hoàn thành chuyên đề này. Sau cùng, xin gửi lời chúc sức khỏe đến tất cả mọi người! Trân Trọng Người thực hiện Võ Công Phát iii Luan van TÓM TẮT Robot tiếp tân có khả năng thay thế con ngƣời thực hiện các công việc nhƣ hƣớng dẫn hay chia sẽ thông tin nhƣng mộtthách thức chung đối với các robot này là khả năng tự xác định vị trí của mình trong khu vực hoạt động.
Nhằm giải quyết vấn đề trên, đề tài đã lựa chọn và trang bịtrên robot một cảm biến RPLiDAR để thu thập dữ liệu địa hình bằng laser 2D sau đó xây dựng bản đồ mà khôngcần dữ liệu có sẵn. Đề tàixoay quanh việc ứng dụng thuật toánSLAM trên robot tiếp tân. Phần đầu đề cập đếncác thành phần cơ bản của SLAMbao gồm mô tả giải thuật bộ lọc Kalman mở rộng- một trong những thành phần chính của thuật toán dùng để ƣớc tính vị trí của robot trong các bản đồ. Sau đó là liệt kê một số phƣơng pháp xử lý tín hiệutrongmôi trƣờngMATLAB và tổng quan về các cảm biến đƣợc sử dụng trong đề tài.Phần tiếp theo sẽ trình bày phƣơng pháp thử nghiệm cảm biến trong tính toán odometry vàcảm biến quét không gian xung quanh.
Cuối cùng là sự kết hợp dữ liệu của các cảm biến đã đƣợc lựa chọn và kết quả thực nghiệm của toàn bộ hệ thống trong thực tế. iv Luan van ABSTRACT Service robot is able to replace humans in guiding or sharing information, however, thisrobot faces a challenge of locating its position in a particular environment. For the purpose of solving the problem, author has select and equip the robot with RPLiDAR sensor for collecting data and building map bability without available data. This dessertation mainly focuses on the application of SLAM agolthrism to service robot.
The first part mentions SLAM’s fundamental parts including descripting extended Kalman filter, one of the main parts of this agolthrism, to estimate the robot’s position in maps. Then, methods solving signals in MATLAB environment is listed, and overview of sensors used in thi research is provided. The next part presents sensor enperiment method in odometry calculation and scanner sensor. The last is the data combination of sensors chosen and test results of the research in practice.
v Luan van MỤC LỤC TRANG TỰA TRANG LÝ LỊCH KHOA HỌC. I LỜI CAM ĐOAN. II CẢM TẠ. IV MỤC LỤC.
VI DANH SÁCH CÁC TỪ VIẾT TẮT. VIII DANH MỤC HÌNH ẢNH. IX DANH MỤC BẢNG. XII CHƢƠNG I TỔNG QUAN .2 CÁC NGHIÊN CỨU LIÊN QUAN ĐẾN ĐỀ TÀI .1 CÁC NGHIÊN CỨU NGOÀI NƢỚC .2 NGHIÊN CỨU TRONG NƢỚC .3 LÝ DO CHỌN ĐỀ TÀI .4 MỤC TIÊU NGHIÊN CỨU .5 ĐỐI TƢỢNG VÀ PHẠM VI NGHIÊN CỨU .6 Ý NGHĨA KHOA HỌC VÀ THỰC TIỄN .7 PHƢƠNG PHÁP NGHIÊN CỨU .1 CƠ SỞ PHƢƠNG PHÁP LUẬN .2 CÁC PHƢƠNG PHÁP NGHIÊN CỨU CỤ THỂ.8 KẾ HOẠCH THỰC HIỆN .9 CHƢƠNG II CƠ SỞ LÝ THUYẾT .1 MỘT SỐ PHƢƠNG PHÁP ĐỊNH VỊ TRONG ROBOT .1 PHƢƠNG PHÁP TIÊN ĐOÁN DEAD-RECKONING.2 HỆ THỐNG DẪN ĐƢỜNG CỘT MỐC CHỦ ĐỘNG.3 HỆ THỐNG DẪN ĐƢỜNG CỘT MỐC .4 XỬ LÝ HÌNH ẢNH THU THẬP TỪ CAMERA .12 vi Luan van 2.5 ĐỊNH VỊ SỬ DỤNG TIA LASER .2 PHƢƠNG ÁN THỰC HIỆN .3 BỘ LỌC KALMAN MỞ RỘNG - EKF .15 CHƢƠNG III XÂY DỰNG MÔ HÌNH THU THẬP VÀ CHUẨN HÓA DỰ LIỆU .1 XÂY DỰNG MÔ HÌNH ROBOT .1 CẤU TRÚC CƠ KHÍ.2 CẤU TRÚC HỆ THỐNG ĐIỀU KHIỂN .1 MÁY TÍNH XỬ LÝ TRUNG TÂM .2 CẢM BIẾN NGOẠI VI QUÉT LISER 2D RPLiDAR .3 CÁC CẢM BIẾN TRẠNG THÁI ROBOT – IMU .36 CHƢƠNG IV THUẬT TOÁN XÂY DỰNG BẢN ĐỒ VÀ ĐIỀU KHIỂN CHUYỂN ĐỘNG.1 PHƢƠNG PHÁP TÁCH DỮ LIỆU ĐOẠN THẲNG.1 XỬ LÝ CÁC ĐIỂM KHÔNG TUYẾN TÍNH - SPIKES .2 XỬ LÝ CÁC ĐIỂM THEO QUY LUẬT (RANSAC) .3 SLAM KẾT HỢP KALMAN MỞ RỘNG (EKF-SLAM) .2 ƢỚC LƢỢNG TRẠNG THÁI ROBOT VÀ XÂY DỰNG BẢN ĐỒ .3 ĐIỀU KHIỂN BÁM QUỸ ĐẠO .1 THIẾT KẾ BỘ ĐIỀU KHIỂN .61 CHƢƠNG V KẾT QUẢ MÔ PHỎNG VÀ THỰC NGHIỆM .1 PHƢƠNG PHÁP ĐỂ ĐO ODOMETRY TRONG THỰC TẾ .2 KẾT QUẢ CẢM BIẾN QUÉT LASER TRONG MÔI TRƢỜNG .3 MÔ HÌNH THỰC TẾ .69 CHƢƠNG VI KẾT LUẬN VÀ HƢỚNG PHÁT TRIỂN .74 TÀI LIỆU THAM KHẢO .76 vii Luan van DANH SÁCH CÁC TỪ VIẾT TẮT RPLiDAR - Robopeak Light Detection and Ranging RANSAC - Random Sampling Consensus LiDAR - Light Detection and Ranging SLAM - Simultaneous Localization and Mapping IMU - Inercial Measurment Unit USB - Universal Serial Bus UART - Universal Asynchronous Receiver/Transmitter EKF - Extended Kalman Filter GUI - Graphical User Interface viii Luan van DANH MỤC HÌNH ẢNH HÌNH TRANG Hình 1.1:Hai robot của đội Hector Darmstadt [1].2: Bài thi cuối của cuộc thi RoboCup 2012 [1].3:Spot sử dụng công nghệ LiDAR để điều hƣớng [2] .4: Robot hút bụi XV-11 [17] .5: Xe không ngƣời lái của Google .1: Định vị sử dụng vật mốc [3] .2: Định vị và dẫn đƣờng cho robot chuyển động sử dụng camera .3: Tổng quan về quá trình SLAM .4: Ma trận tổng quát phƣơng sai P .5: Ma trận Jacobian H của phép đo .6: Ma trận Jacobian H của phép đo .7: Ma trận tổng quát phƣơng sai P .1: Kết cấu tổng thể và bản vẽ đế dƣới của robot tiếp tân .2: Cấu trúc truyền nhận dữ liệu trên Robot tiếp tân .3: Các cổng kết nối của máy tính điều khiển .3: Cảm biến quét laser RPLiDAR lắp trên robot [5].4: Dữ liệu trả về từ cảm biến laser cho mỗi mẫu.5: Nguyên lý một hệ thống laser đo đạc theo cơ sở hin ̀ h tam giác .6: So sánh hai trƣờng hợp đọc dữ liệu từ cảm biến RPLIDAR .7: Độ lệch chuẩn của cảm biến RPLIDAR .8: Sai số phép đo của cảm biến RPLIDAR .9: Độ phân giải của cảm biến RPLIDAR .10: Motor Transmotec PD4266 [10] .11: Cảm biến con quay hồi chuyển MPU6050 .12: Trạng thái và các thông số của robot trong hệ tọa độ .13: Kiểm tra dữ liệu thu thập trên Matlab .43 ix Luan van Hình 3.14: Sơ đồ các dữ liệu đầu vào cho thuật toán SLAM .15: Dữ liệu đầu vào từ các cảm biến .16: Xử lý đọc dữ liệu từ các cảm biến với các mốc thời gian khác nhau [16] .1: Lƣu đồ thuật toán xác định điểm mút của đoạn thẳng .2: Lƣu đồ thuật toán RANSAC .3: Một tập hợp dữ liệu mẫu thu thập đƣợc từ RPLiDAR .4: Chọn 2 giá trị mẫu ngẫu nhiên .5: Vẽ đƣờng giả định .6: So sánh điểu kiện tổng hợp .7: Lập lại inliers giả định .8: Dữ liệu quét laser trong phòng thí nghiệm.9: Đoạn thẳng rút ra từ dữ liệu quét laser trong hình 4.11: EKF-SLAM nâng cấp .12: Giao diện mô phỏng xây dựng bản đồ .13: Nguyên tắc "chia để trị" đƣợc sử dụng trong chƣơng trình tuyến tính .14: Đo thông số của một đƣờng thẳng trong môi trƣờng .15: Trạng thái và các thông số của robot .16: Sơ đồ khối vòng điều khiển động học.1: Kiểm tra odometry - đƣờng thẳng trực tiếp 10 mét .2: Kiểm tra odometry - di chuyển theo đƣờng tròn (10 vòng) .3: Kiểm tra odometry - di chuyển theo hình chữ nhật .4: Kiểm tra odometry - di chuyển trở về vị trì ban đầu (phòng thí nghiệm)65 Hình 5.5: Kiểm tra odometry - di chuyển ngẫu nhiên và encoder bị “trƣợt” .6: Kiểm tra odometry - di chuyển thay đổi góc ngẫu nhiên .7: Dữ liệu của cảm biến RPLIDAR trong không gian nhỏ và hành lang .8: Dữ liệu của cảm biến RPLIDAR trong phòng học có bàn ghế .