ĐẠI HỌC QUỐC GIA THÀNH PHỐ HỒ CHÍ MINH TRƯỜNG ĐẠI HỌC BÁCH KHOA ------------------------------ NGUYỄN VĂN TIẾN ANH STUDY ON CONTROL OF UXA90-LIGHT HUMANOID ROBOT NGHIÊN CỨU ĐIỀU KHIỂN ROBOT UXA90-LIGHT CHUYÊN NGÀNH: KỸ THUẬT CƠ ĐIỆN TỬ MÃ SỐ CHUYÊN NGÀNH: 60.14 LUẬN VĂN THẠC SĨ HƯỚNG DẪN KHOA HỌC: PGS. NGUYỄN TẤN TIẾN TP. HCM, 2017 ĐẠI HỌC QUỐC GIA THÀNH PHỐ HỒ CHÍ MINH TRƯỜNG ĐẠI HỌC BÁCH KHOA ------------------------------ NGUYỄN VĂN TIẾN ANH STUDY ON CONTROL OF UXA90-LIGHT HUMANOID ROBOT NGHIÊN CỨU ĐIỀU KHIỂN ROBOT UXA90-LIGHT CHUYÊN NGÀNH: KỸ THUẬT CƠ ĐIỆN TỬ MÃ SỐ CHUYÊN NGÀNH: 60.14 LUẬN VĂN THẠC SĨ HƯỚNG DẪN KHOA HỌC: PGS. NGUYỄN TẤN TIẾN TP.
HCM, 2017 CÔNG TRÌNH ĐƯỢC HOÀN THÀNH TẠI TRƯỜNG ĐẠI HỌC BÁCH KHOA –ĐHQG -HCM Cán bộ hướng dẫn khoa học : PGS. NGUYỄN TẤN TIẾN. (Ghi rõ họ, tên, học hàm, học vị và chữ ký) Cán bộ chấm nhận xét 1 :PGS. NGUYỄN THANH PHƯƠNG.
(Ghi rõ họ, tên, học hàm, học vị và chữ ký) Cán bộ chấm nhận xét 2 :PGS. (Ghi rõ họ, tên, học hàm, học vị và chữ ký) Luận văn thạc sĩ được bảo vệ tại Trường Đại học Bách Khoa, ĐHQG Tp. HCM ngày 04 tháng 07 năm 2017 Thành phần Hội đồng đánh giá luận văn thạc sĩ gồm: (Ghi rõ họ, tên, học hàm, học vị của Hội đồng chấm bảo vệ luận văn thạc sĩ) 1. TRẦN THIÊN PHÚC 2.
NGUYỄN THANH PHƯƠNG 3. LÊ ĐỨC HẠNH 5. PHÙNG TRÍ CÔNG Xác nhận của Chủ tịch Hội đồng đánh giá LV và Trưởng Khoa quản lý chuyên ngành sau khi luận văn đã được sửa chữa (nếu có). CHỦ TỊCH HỘI ĐỒNG TRƯỞNG KHOA………… ĐẠI HỌC QUỐC GIA TP.HCM CỘNG HÒA XÃ HỘI CHỦ NGHĨA VIỆT NAM TRƯỜNG ĐẠI HỌC BÁCH KHOA Độc lập - Tự do - Hạnh phúc I.
NHIỆM VỤ LUẬN VĂN THẠC SĨ Họ tên học viên: NGUYỄN VĂN TIẾN ANH. Ngày, tháng, năm sinh: 19/05/1992. Chuyên ngành: Kỹ thuật Cơ điện tử. TÊN ĐỀ TÀI: NGHIÊN CỨU, ĐIỀU KHIỂN ROBOT UXA90-LIGHT II.
NHIỆM VỤ VÀ NỘI DUNG: - Tìm hiểu tổng quan về vấn đề nghiên cứu, từ đó xác định đầu bài công việc cụ thể - Mô hình hóa hệ thống - Thiết kế bộ điều khiển - Mô phỏng/thực nghiệm đánh giá kết quả - Kết luận III. NGÀY GIAO NHIỆM VỤ : (Ghi theo trong QĐ giao đề tài) 15/05/2016 IV. NGÀY HOÀN THÀNH NHIỆM VỤ: (Ghi theo trong QĐ giao đề tài) 19/06/2017 V. CÁN BỘ HƯỚNG DẪN (Ghi rõ học hàm, học vị, họ, tên): PGS.NGUYỄN TẤN TIẾN.
CÁN BỘ HƯỚNG DẪN CHỦ NHIỆM BỘ MÔN ĐÀO TẠO (Họ tên và chữ ký) (Họ tên và chữ ký) TRƯỞNG KHOA (Họ tên và chữ ký) Ghi chú: Học viên phải đóng tờ nhiệm vụ này vào trang đầu tiên của tập thuyết minh LV Acknowledgements (Lời cảm ơn) Trong quá trình thực hiện luận văn này, tôi xin gửi lời cảm ơn đến những người đã hỗ trợ giúp đỡ mình trong suốt thời gian qua. Đầu tiên, tôi xin gửi lời cảm đến thầy Nguyễn Tấn Tiến, người đã hướng dẫn tôi thực hiện nghiên cứu đề tài này, tạo điều kiện để tôi có thể tham gia dự án thực tế về Humanoid robot, tham gia các hội nghị khoa học trong lĩnh vực nghiên cứu để tích lũy và trao đổi kiến thức chuyên môn. Tiếp theo, lời cảm ơn xin được gửi tới thành viên của Hi-Tech Lab hỗ trợ tôi trong việc góp ý, trao đổi trong công việc, giúp tôi thiết kế modun ZMP được sử dụng trong luận văn này. Cuối cùng tôi xin cảm ơn đến quý thầy trong bộ môn Cơ điện tử đã truyền đạt kiến thức cho tôi xuyên suốt từ đại học đến thời điểm thực hiện luận văn này.
Tp Hồ Chí Minh, 17 tháng 6 năm 2017 Nguyễn Văn Tiến Anh i Abstract This thesis presents the study on walking control of biped robot based on humanoid robot UXA-90. The forward and inverse kinematics of 12 DoF biped robot were solved, a simulation tool also developed to implement walking gait. The experiment results show that robot can be stable walking by using the gait was designed. Tóm tắt Luận văn này trình bày phương pháp hoạch định quỹ đạo cho chuyển động đi hai chân của Humanoid robot và áp dụng lên robot UXA-90.
Dựa trên thông số động học của robot này, bài toán động học thuận và ngược của hai chân robot 12 DoF đã được giải quyết, một mô hình mô phỏng đã được xây dựng. Kết quả thực nghiệm cho thấy quỹ đạo hoạch định có thể làm robot đi ổn định. ii Declaration This thesis is a presentation of my original research work. Wherever contributions of others are involved, every effort is made to indicate this clearly, with due reference to the literature, and acknowledgement of collaborative research and discussions.
Nguyễn Văn Tiến Anh iii Table of Contents Acknowledgements. iii Table of Contents. iv List of Figures. vii List of Tables.
ix List of Abbreviations .1 Adult-sized humanoid robot .1 WABIAN series of Waseda University .2 Honda Humanoid robot .3 HRP series of AIST/KAWADA .4 HUBO series of KAIST .5 Boston Dynamics Humanoid robot .6 NASA’s Humanoid robot .2 Child-sized humanoid robot .1 Nao Humanoid robot .2 iCub Humanoid robot .3 DARwIn-OP Humanoid robot .4 UXA-90 Humanoid robot .1 Introduction to human walking gait .2 Humanoid robot walking pattern generation .3 The stability of biped walking.4 Overview of the Thesis .14 CHAPTER 2: BIPED ROBOT: MODELING AND KINEMATICS .1 Modeling of biped robot .1 The Zero Moment Point .3 The Linear Inverted Pendulum Model.4 The Cart-Table Model .2 Kinematics of biped robot .29 CHAPTER 3: CONTROL OF WALKING GAIT .35 CHAPTER 4: SIMULATION AND EXPERIMENT .2 Experiment on UXA-90 robot .2 Experiment results and discussion .1 Remark of UXA-90.2 Contributions of thesis .3 Recommendations for future research .46 Appendix A: MATLAB code .48 Appendix B: UXA-90 datasheet .53 vi List of Figures Figure 1.1 Wabian-2 humanoid robot .2 Honda humanoid robots .3 HRP humanoid robots .4 Humanoid robots of KAIST .5 Boston Dynamics humanoid robots .6 Valkyrie humanoid robot .7 NAO humanoid robot.8 DARwIn-OP humanoid robot .9 UXA-90 humanoid robot .10 Human walking cycle [16] .11 CoM, ZMP, and Support Polygon [18] .12 The approaches used for generating walking patterns of biped robot [19]11 Figure 1.1 Biped mechanism and forces acting on its sole .2 The ground reaction forces 𝑓𝑖 = [𝑓𝑖𝑥 𝑓𝑖𝑦 𝑓𝑖𝑧 ] at the discretized points 𝑝𝑖 = 𝑇 [𝑝𝑖𝑥 𝑝𝑖𝑦 𝑝𝑖𝑧 ] .3 Schematic 3D Biped model and ZMP at P .5 The Cart-Table model .6 Basic parameters of UXA-90 .7 The coordination of biped robot.8 The coordinates on let leg .9 The coordinates on right leg.10 Characterization of generic link 𝒊 .11 Inverse kinematic algorithm.12 Inverse kinematic of a singular posture.1 Pattern generation as ZMP tracking control .2 ZMP reference and CoM trajectory on 𝒙 direction.3 ZMP reference and CoM trajectory on 𝑦 direction.4 Footstep planning, ZMP reference and CoM trajectory in 𝑥𝑦 plan .5 Ankle trajectories design with 𝐿𝑎0 = 𝐷𝑠/2, 𝐻𝑎0 = 0.6 Walking gait of 4 steps with single support, double support, swing, stance phase time are: 𝑇𝑠𝑠 = 0.1 The block diagram of biped robot walking simulation .2 Joints position during walk .3 Configuration of 4 sensors on each foot .4 Attachment of each sensor include: (1) Contact point; (2) Foot plate 1; (3) Rigid plate 1; (4) Rigid plate 2; (5) Flexi Force A401 sensor; (6) Foot plate 2 .5 Magnitude of pressure .6 Implement walking gait on real robot .7 Simulation and experiment result of ZMP .1 System schematic of robot UXA-90 .2 ROS software is being developed by author .1 The binary tree of robot link .3 SAM-30 and SAM-100P specifications .4 SAM-160P and SAM-210P specifications .52 viii List of Tables Table 1.1 The methods of the pattern generators for biped walking [20].1 Modified Denavit-Hartenberg parameter of the legs .24 ix List of Abbreviations CoM Center of Mass CoP Center of Pressure DoF Degree of Freedom DSP Double Support Phase SSP Single Support Phase ZMP Zero-Moment Point 3D LIPM 3D Linear Inverted Pendulum Model ROS Robot Operating System x CHAPTER 1: INTRODUCTION CHAPTER 1: INTRODUCTION During the past three decades research, development of robotics has expanded from traditional industrial robot manipulators to include autonomous and animal-like or humanoid robots. The field of humanoid robotics is concerned with the creation of robots which are broadly human-like in their behavior, their morphology or both. Building truly humanoid robots will require significant advances in areas including high-level cognition, computer vision, speech synthesis, speech recognition, manipulation and biped locomotion. Over the past two decades, the field of humanoid robotics has witnessed significant advances and many humanoid robots project have been developed.1 Adult-sized humanoid robot 1.1 WABIAN series of Waseda University Figure 1.1 Wabian-2 humanoid robot The first humanoid research was performed by Kato and Tsuiki at Waseda University in Japan in 1972.
This research realized a static walking by a heavy model: 1 CHAPTER 1: INTRODUCTION WL-5 a three-dimensional, 11 DoF1 walker [1]. The WL-5 was used as the lower limbs of the WABOT-1 [2] which is the first full-scale anthropomorphic robot developed in the world. It consisted of a limb-control system, a vision system and a conversation system. The WABOT-1 was able to communicate with a person in Japanese and to measure distances and directions to the objects using external receptors, artificial ears and eyes, and an artificial mouth.
The WABOT-1 walked with its lower limbs and was able to grip and transport objects with hands that used tactile sensors. In 1984, the research group developed WABOT-2, a robot capable of performing on musical instruments with a capability equivalent to that of a professional musician. In 2006, WABIAN-2 was released [3]. Its trunk is designed in order to permit rotation, and forward, backward, and side-way movement.
Further, its arms are designed to support its complete weight when pushing a walk assist machine. Moreover, it can lean on a walk-assist machine by forearm control using trunk motion.2 Honda Humanoid robot Figure 1.2 Honda humanoid robots Honda has been doing research on robotics since 1986, the research started with straight and static walking of biped robot [4], [5]. In December 1996, they announced 1 Degree of Freedom 2 CHAPTER 1: INTRODUCTION the world’s first self-regulating two-legged humanoid robot P2. It has 182 [cm] tall, weighs 210 [kg] with total 34 of DoF.
Because heavy, it has operational time of only 15 min and can walking on an uneven floor. In 2000, Honda introduced ASIMO1. ASIMO can both walk and run (at speeds of up to 3 [km/h]), and the current version incorporates a total of 57 DoF. ASIMO can also walk up and down stairs, and perform dance routines.
ASIMO can walk in a straight line, on a circle, turn and even slalom, enabling ASIMO to operate in most common human environments. As well as improving the complexity of its walking direction.3 HRP2 series of AIST/KAWADA The HRP is a project for development of general domestic helper robot in Japan. This project is spearheaded by Kawada Industries and supported by the National Institute of Advanced Industrial Science and Technology (AIST) and Kawasaki Heavy Industries, Inc. In 1997, the project released robot HRP-1, this robot was developed based on Honda P3 robot.
HRP-1 has been used for investigating the applications of a humanoid robot for the maintenance task of industrial plants and security services of home and office [6]. After that, the project developed HRP-1S robot. In this robot, they combined Honda P3 hardware and AIST controller. Its legs and arms are controlled separately and not suitable for some application [7].