Nội dung

MINISTRY OF EDUCATION AND TRAINING VIETNAM ACADEMY OF SCIENCE AND TECHNOLOGY GRADUATE UNIVERSITY OF SCIENCE AND TECHNOLOGY ------------------------------- HA THI KIM DUYEN ADAPTIVE DYNAMIC SURFACE TRAJECTORY TRACKING CONTROL FOR THE FOUR-WHEELED OMNIDIRECTIONAL MOBILE ROBOT Majors: Control and Automation Engineering Code: 9 52 02 16 ELECTRICAL, ELECTRONIC AND TELECOMMUICATION ENGINEERING Hanoi – 2020 Publications at: Graduate University of Science and Technology – Vietnam Academy of Science anf Technology Advisor 1: Prof. Phan Xuan Minh Advisor 2: Dr. Pham Van Bach Ngoc Reviewer 1: Reviewer 2: Reviewer 3: The thesis is defended at the PhD dissertation committee, which meets at Graduate University of Science and Technology – Vietnam Academy of Science and Technology at…………,2020 Thesis can be found at: - Library of Graduate University of Science and Technology - National Library of Vietnam LIST OF AUTHOR’S PUBLICATIONS SCIENTIFIC JOURNAL 1. Duyen Ha Thi Kim, Tien Ngo Manh, Cuong Nguyen Manh, Nhan Duc Nguyen, Manh Tran Van, Dung Pham Tien, Minh Phan Xuan. “Adaptive Control for Uncertain Model of Omni-directional Mobile Robot Based on Radial Basis Function Neural Network”. International Journal of Control, Automation, and Systems (SCI-E Q2, Impact Factor: 2.7) (Accepted 2020) 2. Ha Thi Kim Duyen, Ngo Manh Tien, Pham Ngoc Minh, Quang Vinh Thai, Phan Xuan Minh, Pham Tien Dung, Nguyen Duc Dinh, Hiep Do Quang, “Fuzzy Adaptive Dynamic Surface Control for Omnidirectional Robot”, the Springer-Verlag book series “Computational Intelligence” indexed in Scopus and Compendex (Ei). ISSN 1860-9503 (electronic), ISBN 978-3-030-49536-7 (eBook). https://doi.org/10.1007/978-3-03049536-7. (2020) 3. Hà Thị Kim Duyên, Phạm Thị Thanh Huyền, Trương Bích Liên, Ngô Mạnh Tiến, Lê Việt Anh, Nguyễn Mạnh Cường, “Điều khiển bám quỹ đạo đối thượng Robot tự hành bằng thuật toán điều khiển trượt theo hàm mũ”, Tạp chí Nghiên cứu KH&CN quân sự, Số Đặc san ACMEC, 07 – 2017. ISSN 1859 - 1043 4. H T ị D , Ngô Mạnh Tiến, Phan Xuân, Minh Lê Xuân Hải, Vũ Đức Thuận, Nguyễn Minh Huy, “Điều khiển bám quỹ đạo Omni robot bốn bánh bằng phương pháp thích nghi mờ trượt”. Tạp chí Nghiên cứu Khoa học và Công nghệ quân sự. Số đặc san ACMEC 07-2017. ISSN 1859 - 1043 5. Ngo Manh Tien, Nguyen Nhu Chien, Do Hoang Viet, Ha Thi Kim Duyen “Research And Development Artificial Intelligence To Track Trajectory And Automatically Path Planning For Auto Car”. Journal of Military Science and Technology; ISSN 1859 – 1043. 11/2018 6. Duyen – Ha Thi Kim, Tien – Ngo Manh, Chien – Nguyen Nhu, Viet – Do Hoang, Huong-Nguyen Thi Thu Kien-Phung Chi, “Tracking Control For Electro-Optical System In Vibration Enviroment Based On Self-Tuning Fuzzy Sliding Mode Control”, Journal of Computer Science and Cybernetics, Vol 02, 6.2019. SCIENTIFIC CONFERENCE 7. Ngô Mạnh Tiến, Nguyễn Như Chiến, Đỗ Hoàng Việt, H T ị D , Nguyễn Tuấn Nghĩa, “Trajectory Tracking Control for Four Wheeled Omnidirectional Mobile Robots using Adaptive Fuzzy Dynamic Surface Control Algorithm”, Proceedings the 4th Vietnam International Conference and Exhibition on Control and Automation VCCA2017; ISBN 978-604-73-5569-3 8. Duyen Ha Thi Kim, Tien Ngo Manh, Tuan Pham Duc and Ngoc Pham Van Bach, “Trajectory Tracking Control for Omnidirectional Mobile Robots Using Direct Adaptive Neural Network Dynamic Surface Controller”. The 2019 First International Symposium on Instrumentation, Control, Artificial Intelligence, and Robotics. 1/2019. NSPEC Accession Number: 18473513, DOI: 10.1109/ICA-SYMP.2019.8646146. 9. Ha Thi Kim Duyen, Cuong Nguyen Manh, Hoang Thuat Vo, Manh Tran Van, Dinh Nguyen Duc, Anh Dung Bui, “Trajectory tracking control for four wheeled Omnidirectional mobile Robot using backstepping technique aggregated with sliding mode control”, The 2019 First International Symposium on Instrumentation, Control, Artificial Intelligence, and Robotics. 1/2019. INSPEC Accession Number: 18473501, DOI: 10.1109/ICA-SYMP.2019.8646041. 10. Ngô Mạnh Tiến, Nguyễn Mạnh Cường, H T ị D , Phan Sỹ Thuần, Nguyễn Ngọc Hải, Trần Văn Hoàng, Nguyễn Văn Dũng, “Giám sát định vị, bản đồ hóa và điều hướng cho robot tự hành đa hướng sử dụng hệ điều hành lập trình ROS”, Hội nghị Quốc gia lần thứ XXII về Điện tử, Truyền thông và Công nghệ Thông tin lần thứ 22, 2019. 1 INTRODUCTION 1. Rasionale of the thesis Omni-directional mobile robot (OMR) is a holonomic robot using Omni or Mecanum wheel, which can move in any direction without changing the robot’s position and rotation angle. Due to the outstandingly moving in narrow environmental conditions when using the particular wheel structure and wheel layout, OMR is being widely applied and developed not only in research but has quickly become widely used in production and life fields. In robot control, the problem of trajectory tracking control, dealing with external disturbance, and the uncertain part existing in the robot model, including mass, moment, and friction,… is the content which is significantly focused in research. The task which is to guarantee the high accuracy in the robot motion is commonly difficult because of the nonlinear and uncertain parts typically existing in the robot model. 2. Research Objective - Research and propose a novel adaptive trajectory tracking algorithm for FWOMR ‘s nonlinear uncertain model which is influenced by the change of robot parameters and the effect of noise when operating on another plane. - Construct the physical model of FWOMR and the controller based on the microchip and embedded programming technique to experiment with the proposed algorithms. 3. Object and scope The object of the study: a four-wheeled omnidirectional mobile robot. The thesis puts emphasis on the construction of the mathematical robot model and the adaptive trajectory tracking control algorithms for FWOMR. The study scope: Design an adaptive controller for FWOMR model which is influenced by the uncertain elements in the flat environment affected the surface friction and bounded abitrary noise. 4. Scientific significance and new contributions of the thesis 1. Propose an adaptive fuzzy dynamic surface control (AFDSC) for the four-wheeled omnidirectional mobile robot. The algorithm is constructed based on the DSC technique. To take advantage of the DSC, AFDSC uses a fuzzy rule tuning the DSC parameters to guarantee the trajectory tracking quality when the FWOMR’s parameters are variable and are affected by the unknown disturbance. Until now, the DSC tuned by the fuzzy rule has not ever been installed in any mobile robot platforms in domestic and overseas. 2. Propose an adaptive fuzzy neural network dynamic surface control (AFNNDSC) for FWOMR which contains uncertain parameters and its model is affected by the disturbance. The algorithm is developed based on the DSC technique, its adaptive characteristic is created by the combination of the radial basis function neural network (RBFNN) and the fuzzy law. The RBFNN is to approximate uncertain parameters of the FWOMR, while the fuzzy law simultaneously tunes the control parameter. The system stability is verified by the Lyapunov standard. Simulation results and experiments show the accuracy and effectiveness of the proposed method and its practical application ability. The AFNNDSC has not ever been installed in any robot platforms in domestic and overseas. Moreover, the AFNNDSC has highly flexible and adaptive characteristics when the robot is 2 adversely influenced by the disturbance, and the model’s parameters are variable. That leads to the expansion of the robot’s operation scope. The algorithms are installed and successfully experimented in the four-wheeled omnidirectional mobile robot. The constructed robot has the high-performance processor control circuit and the software built on ROS. 5. Thesis layout Chapter 1: “An overview of the four-wheeled omnidirectional mobile robot”. An overview study of FWOMR, domestic and international research, detailed analysis of advantages and disadvantages of previously researched works according to the content of the subjects, the research scope of the thesis, from there draw appropriate research directions for the thesis. Chương 2: “Modeling and trajectory control algorithms for the four-wheeled omnidirectional mobile robot”. This chapter shows the construction of the dynamic model for FWOMR and a presentation of some typical trajectory control algorithms for FWOMR. Moreover, the simulation, evaluation, and analysis the results of these algorithms are to evaluate and draw lessons learned in the proposed study of the new adaptive orbital control algorithm. Chapter 3: “Design an adaptive trajectory tracking controller for the four-wheeled omnidirectional robot”. The chapter is the main contribution of the thesis. In this chapter, an adaptive trajectory tracking controller for the four-wheeled omnidirectional robot using a dynamic surface control is presented. The DSC algorithm is the platform for the control quality improvement using the proposed adaptive trajectory tracking controller. The DSC controller is combined with a radial basis function neural network (RBFNN) and fuzzy logic system (FLS) to design a novel adaptive DSC controller which is proposed in the thesis. Chương 4: “Manufacture the four-wheeled omnidirectional mobile robot and experiment with the proposed control algorithm”. This chapter shows the design and manufactures the four-wheeled omnidirectional mobile robot model, and programming and experiment of the proposed algorithms to verify and evaluate the practical applicability. “Conclusion” presents the abstract of the main contributions and future works. AN OVERVIEW OF THE FOUR-WHEELED OMNIDIRECTIONAL MOBILE ROBOT Omnidirectional mobile robots (OMR) are capable to move in any direction without the changing its direction and position. With a particular wheel structure and the advantage of flexible movement in the environment which is narrow and difficult to change the position. Nowadays, OMR is widespreadly applied not only in research but in the various production fields due to its ability to flexible and omnidirectional move. 1.1. Autonomous mobile robot built with omnidirectional wheel. In the thesis scope, a holonomic mobile robot is constructed using four Omni wheels with a consistent structure, which ensures that the robot can promptly move in horizontal direction. 1.2. Trajectory tracking control problem The structure of the motion control system for OMR can be devided into three phases: 3 - Set up the motion plan - Plan the reference trajectory - Control robot to track the reference trajectory 1.3. Overview of domestic and international research 1.3.1. Domestic research situation Institute of Information Technology and Institute of Mechanics, Vietnam Academy of Science and Technology Institute of Information Technology and Institute of Mechanics, Vietnam Academy of Science and Technology have a number of published research on autonomous robot research, such as [1] presenting new control methods to compensate the impact of the slip phenomena for mobile robots in the existence of wheel slip, uncertainties, and external noise for 3-wheel mobile robotics, [2] presenting the design and control of a nonholonomic mobile robot for warehouse applications. Institute of Physics, Vietnam Academy of Science and Technology is also a research group with many published works on autonomous robots, including [3] presenting research orientation for trajectory tracking control for nonholonomic mobile robots with the integration of the image processing technology to identify some parameters and track the target. Moreover, [4] conducted research on applying the trajectory tracking control algorithm for the nonholonomic mobile robot using the ideal function adaptation. Nowadays, there are a few domestic studies on OMR, in which, [5] is an obstacle avoidance control for OMR using Kinect image processing technology. In addition, this work focuses more on image processing than the field of robot control for OMR. There are not many publications about the trajectory tracking control algorithm for the four-wheeled robots using Ommi wheels in Vietnam. 1.3.2. International research situation The robot was modeled using kinematic and dynamic models. Robot modelling was researched based on Euler-Lagrange equations, which used theoretical and experimental methods [31], [32], [33], [34], [35], [36], [37], [38], [39], [40]. A mount of research focused on the navigation system and motion control based on the robot kinematic model of OMR [43], [44], [45], and [46]. The PID algorithm was applied for trajectory tracking control of the four-wheeled OMR in [43] and [44]. However, recent research has considered both kinematic and dynamic models to enhance the accuracy in robot movement [42] and [43]. The design of the trajectory tracking control algorithm for OMR taking into account all the kinematic and dynamic models has been considered in [39]. The dynamic model is constructed in [47] and [48], followed by a number of trajectory tracking control algorithms for this full model in [49] and [50]. Studies have used PI controllers to optimize orbital adhesion [52], [57], and [79]. On the other hand, the algorithm using the predictive model has also been mentioned in [51]. More and more research is focused on feedback control methods for the nonlinear model 52], [53], [54], [55], [56], and [57]. The Backstepping feedback method is a viable solution to solve affined models [58] and [59]. However, with high order nonlinear systems, the computational volume is large, complicated, and takes too many computation time due to the need to calculate the derivative in each iteration step. 4 Sliding mode control (SMC) has also been used [60], [61], [62] and [63 for its superior properties in the case of the system affected by noise. However, the limitation of the SMC algorithm is chattering, and reducing this phenomenon requires an accurate object model. It goes against the properties of the robot model, which is the parameter uncertainty. In order to improve the quality of control as well as to limit some of the disadvantages of the Backstepping and SMC controllers, a dynamic surface control (DSC) technique is introduced in [64] and [65]. The design steps are similar to those of the Backstepping, but to avoid derivative steps for the DSC virtual control signal, a low pass filter is added, just to get information about the lead. medium function to filter the high-frequency internal noises occurring in the control object [65]. For OMR, it is challenging to build an accurate mathematical model because factors such as friction, load change, and environmental conditions are not known. Therefore, the effective modern design methods, in this case, are to use adaptive algorithms to tune controller parameters using Fuzzy logic or approximate the uncertainties using neural networks. This adaptive controller significantly improves the quality of the nonlinear dynamics [60], [61], [62], [66], [68], [69], [70], [71] and [72]. With the above reference and analysis, a new adaptive control structure based on a radial basis function neural network (RBFNN) and fuzzy logic system for the trajectory tracking controller is researched and developed based on the Dynamic Surface Control (DSC) technique. A novel adaptive controller with RBFNN for the approximation of the nonlinear uncertain parameters of the FWOMR and fuzzy logic to tune the controller's parameter is proposed in the thesis. 1.4. Conclusion Chapter 1 presented an overview of mobile robot classification and autonomous mobile robots, which focuses on an autonomous mobile four-wheeled robot (FWOMR) being the main research object of the thesis. Chapter 1 also focused on a research overview of domestic and international research on OMR modeling and trajectory tracking control algorithms for OMR published and analyzed the advantages and disadvantages of these methods from which to draw appropriate research directions for the thesis. 2. MODELING AND TRAJECTORY CONTROL ALGORITHMS FOR THE FOUR-WHEELED OMNIDIRECTIONAL MOBILE ROBOT Building the system of kinematic and dynamic equations for OMR is the very first problem needed for the synthesis of the trajectory tracking control. In the thesis, the research object considered is an autonomous four-wheeled robot using Omni-type wheels, which moves on the plane is affected by friction. 2.1. Building the kinematic and dynamic models of the four-wheeled omnidirectional mobile robot 2.1.1. The Omni wheel Omni wheels are arranged perpendicular to the axis of the motor, the wheels are spaced 3600 / n apart. Omni wheels are widely used in autonomous robots because it allows the robot to move immediately to a position on a plane without having to rotate before. Furthermore, the translational movement along a straight trajectory can be combined with 5 rotational movement that causes the robot to move to the desired position with the accuracy orientational angle. 2.1.2. Kinematic model of the four-wheeled omnidirectional mobile robot [41], [42] An equation presenting a relationship between the two coordinates is also the robot kinematic model. cosθ -sinθ 0  q  Hv   sinθ cosθ 0  v    0 0 1 (2.1) cosθ -sinθ 0  where: H =  sinθ cosθ 0  is a transition matrix.  0 0 1 From (2.1), we calculate an equation presenting a relationship between the robot’s position and the velocity of wheels:  1   x     y   g ( ) 2  với g ( )  HH (2.4) 2   3      4  2.1.3. Dynamic model of the four-wheeled omnidirectional mobile robot [41], [42] The kinematic and dynamic models of FWOMR are constructed based on a robot model accompanied by the Omni wheels which are positioned 450 apart from the dynamic coordinate and 900 apart from the beside ones. From which, the robot’s dynamic equation has the following formula (2.8) M (q) v  Cv  Gsgn( v)  τ d  Bτ with: v  [ vx vy  ]T is a velocity vector  2 2 2 2    2r 2r 2r   2r  2 2 2 2 B    is a control parameter matrix. 2r 2r 2r   2r d d d   d  r r r r    m 0 0  M (q)   0 m 0  is a matrix with m is the robot mass and J is the inertia moment.  0 0 J  0 0  Bx 0 C x 0    C   0 By 0  and G   0 C y 0  are viscous friction parameter matrix and  0 0 B   0 0 C  Coulomb friction matrix, respectively. 6 2.2. Several existing trajectory tracking control algorithms for the four-wheeled omnidirectional mobile robot. 2.2.1. PID controller for FWOMR The PID controller for FWOMR is proposed in [43] and [44]. These studies have designed the PID controller based on the kinematic model of OMR. Hence, the effects of external forces on the system in the robot's dynamic equation were not taken into account.  1   x (t )   xd     xd      e1   y (t )    y d   g ( )  2    y d  (2.11) 3  (t )  d    d  4  We need to find the angular velocity vector of the wheels for the closed-loop controller to be stable.  t     xe d    1   0   xe    t     2   g T ( )( g ( ) g T ( ))1    K P  ye   K I  ye d      3   0  e       t 4     d     0 e    with K P and K I are diagonal positive definite matrices. (2.12) 2.2.2. Sliding mode control for FWOMR SMC in [60], [61], [62] and [63] is commonly used for robot systems in general and FWOMR in particular because of its robust characteristic with external noises. x  q From (2.1) and (2.8), let  1 , we have state equations: x 2  v x 1  Hx 2 (2.19)  Mx 2  Cx 2  Gsgn( x 2 )  τ d  Bτ with τ d is uncertain and not accurately measured, and thus, this component will not exist during the calculation of SMC, MSSC controllers. Define the sliding surface with conditions and assumptions.  e  x1  x1d Define the errors  1 with x1d is a reference trajectory and x 2d  H 1x 1d is e  x  x 2 2d  2 reference velocity. Choose the sliding surface S  e1  e1 with  >0 is a sliding surface coefficient. Take the sliding surface’s derivative   He  e  H (M 1 (Bτ  Cx  Gsgn(x ))  x  (  H 1H  )e ) S  He 2 2 1 2 2 2d 2 Choose a Lyapunov candidate function (2.20) (2.21) 7 1 V  S2 2 Take its derivative, we obtain  )e ) V  SS  SH (M 1 (Bτ  Cx2  Gsgn(x 2 ))  x 2 d  (  H -1H 2 With the control signal is chosen as follows  )e  x )  Cx  Gsgn(x )  K sgn(S)) τ  BT (BBT )1 (M ((  H 1H 2 2d 2 2 1 V  SK sgn(S)  0 , which satisfies the Lyapunov standard. (2.22) (2.23) (2.24) 1 The sliding controller (2.24) is designed for stability and durability when the system exists with model deviation and impact interference. The function V in the formula (2.22) with control law (2.24) for the FWOMR system is the Lyapunov function of the closed system. 2.2.3. Multiple sliding surface control for FWOMR - Consider the robot’s state equations x 1  Hx 2 (2.36)  Mx 2  Cx 2  Gsgn(x 2 )  τ d  Bτ x  vx  with x1   y  và x 2  v y           - Consider the sliding surface  S11  S1   S12   x1  x1d    S13  (2.37) - Take derivative of S1 and use (2.37), we obtain S  x  x  Hx  x 1 1d 1 2 1d Choose a virtual control signal x 2 d  H 1 ( K1S1  x 1d ) - Choose the first Lyapunov candidate function 1 V1  S1T S1 2 - Take derivative of V1 , and use (2.38) and (2.39) V  ST S  ST K S 1 1 2 1 1 1 (2.38) (2.39) (2.40) (2.41) - Consider S 2 as the second sliding surface S 2  H(x 2  x 2 d ) Taking derivative of S 2  (x  x ) S 2  H(x 2  x 2 d )  H 2 2d  (x  x )  H (M 1 (Bτ  Cx 2  Gsgn(x 2 ))  x 2 d )  H 2 2d Combine (2.39), (2.40), (2.43), and (2.44), we obtain: (2.42) (2.43)