Trajectory tracking control method and device for mobile mechanical arm and storage device

By designing a non-singular fast terminal sliding mode controller, the problem of insufficient control stability and convergence speed of the robot arm under base motion is solved, and fast and stable trajectory tracking control is achieved, avoiding the singularity problem and improving robustness.

CN118977243APending Publication Date: 2024-11-19CHINA UNIV OF GEOSCIENCES (WUHAN)
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411129051.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-16
Publication Date
2024-11-19

AI Technical Summary

Technical Problem

The existing sliding mode control method cannot achieve rapid and stable control of the robotic arm when the base is moved, and there are problems of singularity and insufficient convergence speed.

Method used

A non-singular fast terminal sliding mode (NFTSM) controller was designed. By establishing a dynamic model of the mobile robot arm, the tracking error is defined and the non-singular terminal sliding mode surface is designed. This controller is used to perform the movement of the base. Stabilized trajectory tracking control, using saturation function instead of conforming function to avoid singular problems.

Benefits of technology

Fast and stable tracking control of the moving robot arm in a limited time is realized, inertial disturbance caused by base movement is suppressed, singular problems are avoided, and control performance and robustness are improved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118977243A_ABST
    Figure CN118977243A_ABST
Patent Text Reader

Abstract

The invention provides a mobile mechanical arm trajectory tracking control method and device and a storage device, and relates to the field of mechanical arm trajectory tracking control, a dynamic model is established for a mobile mechanical arm system, and the mobile mechanical arm system comprises a base and a mechanical arm; defining a tracking error; designing an NFTSM controller; designing a nonsingular terminal sliding mode surface according to the tracking error; designing a control law according to the nonsingular terminal sliding mode surface; and under the condition that the base moves, the NFTSM controller is used for carrying out stable trajectory tracking control on the mobile mechanical arm system. The trajectory tracking control device for the mobile mechanical arm and the storage device are used for achieving the trajectory tracking control method for the mobile mechanical arm. The method has the beneficial effect that the rapid and stable trajectory tracking control of the mobile mechanical arm system can be realized under the condition that the base moves.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robot arm trajectory tracking control, and in particular to a mobile robot arm trajectory tracking control method, device and storage device. Background Art

[0002] Over the past few decades, robots have been applied in various fields, such as factory workshops, service industries, and medical fields. Due to their mobility, agility, and flexibility, mobile manipulators have played an increasingly important role in transportation, rescue, and military operations. Modern innovations in robotics and control theory, coupled with increasingly powerful computer systems, have prompted the academic community to shift its research focus to mobile manipulators. Industrial robots are used to perform various tasks, such as moving, assembling, and transporting objects. Mobile manipulators consist of a mobile base and a manipulator, combining the advantages of both and are able to work in more complex environments. Among them, trajectory tracking control is an important control direction for mobile manipulators, and many researchers have conducted extensive research in these areas. Therefore, studying the trajectory tracking control scheme of mobile manipulators is not only of great theoretical significance, but also of great engineering application value.

[0003] In the field of trajectory tracking control of mobile manipulators, many outstanding achievements have emerged, such as sliding mode control (SMC) and adaptive control. Among them, sliding mode control has attracted widespread attention in the field of robot control due to its fast transient response and robustness to disturbances. Traditional sliding mode control uses a linear sliding surface, which causes the asymptotic tracking error to converge to zero in infinite time. In order to accelerate the convergence speed, a terminal sliding mode (TSM) control method using a nonlinear sliding surface is proposed. However, the TSM controller has a singularity problem. To avoid the singularity problem, a non-singular terminal sliding mode (NTSM) is constructed using the power law method. To further improve the convergence speed, some scholars have proposed a non-singular fast terminal sliding mode (NFTSM) control method, which ensures fast convergence near the equilibrium point. Due to its significant advantages, the NFTSM method has been widely used in a variety of electromechanical systems, such as transmission systems, manipulators, and electronic power systems. However, the movement of the base can have a huge impact on the stability of the manipulator. In this case, the existing sliding mode control method cannot achieve satisfactory control performance. Therefore, how to achieve fast and stable control of the robotic arm when the base moves is another important issue that needs to be solved urgently. Summary of the invention

[0004] In order to solve the problem of achieving stability control of a mechanical arm when a base moves, the present invention provides a mobile mechanical arm trajectory tracking control method, device and storage device. A mobile mechanical arm trajectory tracking control method mainly includes:

[0005] S1: Establish a dynamic model for a mobile robotic arm system, which includes a base and a robotic arm;

[0006] S2: Define tracking error;

[0007] S3: Design NFTSM controller:

[0008] Design a non-singular terminal sliding surface based on the tracking error;

[0009] Design control law based on non-singular terminal sliding surface;

[0010] S4: When the base is moving, the NFTSM controller is used to perform stable trajectory tracking control on the mobile robot system.

[0011] A storage device stores instructions and data for implementing a mobile robot arm trajectory tracking control method.

[0012] A mobile robot arm trajectory tracking control device comprises: a processor and a storage device; the processor loads and executes instructions and data in the storage device to implement a mobile robot arm trajectory tracking control method.

[0013] The technical solution provided by the present invention has the following beneficial effects: the present invention considers the trajectory tracking control of the manipulator in the mobile manipulator at the dynamic level, establishes a dynamic model for the mobile manipulator system, and the designed NFTSM controller avoids numerical singularity problems and has fast convergence; the NFTSM has strong robustness for the inertial disturbances caused by the movement of the manipulator base, and can effectively suppress these disturbances. At the same time, the inertial disturbances caused by the movement of the base to the manipulator are considered, and its influence on the stability of the manipulator is reduced. Therefore, the present invention can realize the system's fast and stable trajectory tracking control of the mobile manipulator within a limited time when the base moves. BRIEF DESCRIPTION OF THE DRAWINGS

[0014] The present invention will be further described below with reference to the accompanying drawings and embodiments, in which:

[0015] Figure 1 It is a flow chart of a mobile robot arm trajectory tracking control method in an embodiment of the present invention.

[0016] Figure 2 Schematic diagram of the tracking trajectory of the mobile robot arm in an embodiment of the present invention.

[0017] Figure 3 1 is a diagram of the simulation results of the trajectory tracking control of the mobile robot arm in an embodiment of the present invention, (a) three-dimensional expected trajectory and actual trajectory, (b) two-dimensional actual trajectory and expected trajectory.

[0018] Figure 4 1 is a comparison diagram of the control experiment results of the method proposed in the embodiment of the present invention and the PID and ESO methods, where (a), (b), and (c) represent the position errors of the end effector of the robot arm in the X, Y, and Z directions, respectively.

[0019] Figure 5 It is a schematic diagram of the operation of the hardware device in the embodiment of the present invention. DETAILED DESCRIPTION

[0020] In order to have a clearer understanding of the technical features, purposes and effects of the present invention, specific embodiments of the present invention are now described in detail with reference to the accompanying drawings.

[0021] Please refer to Figure 1 , Figure 1 : is a flow chart of a mobile robot arm trajectory tracking control method in an embodiment of the present invention, which specifically includes:

[0022] S1: Establish a dynamic model for the mobile robot system;

[0023] The mobile robot system consists of a base and a robot. Assuming that the mass of the mobile base is much greater than the mass of the robot, the movement of the base can be regarded as a disturbance to the robot. Therefore, for the n-link rigid robot system, the following dynamic system is established:

[0024]

[0025] where q∈R n is the joint angle, is the joint angular velocity, is the joint angular acceleration, R n represents the real number domain. τ is the joint torque input, τ d represents the additional disturbance, and τ b Represents the disturbance of the robot arm from the base. M(q)∈R n×n is a positive definite inertia matrix, represents the centrifugal force and the Coriolis matrix, and G(q)∈R n×n Represents the gravity vector of the robot arm.

[0026] S2: Define the tracking error as e1=qq d and where q d is the desired joint angle, is the expected joint angular velocity. Therefore, equation (1) can be written as follows:

[0027]

[0028] where e=[e1,e2] T ∈R2n , is the expected angular acceleration,

[0029] S3: Design NFTSM controller:

[0030] The movement of the base will cause a large disturbance to the stability of the mobile robot system. Therefore, for the n-link robot system, it is necessary to compensate for the acceleration caused by the movement of the base. τ in formula (1) b The definition is as follows:

[0031]

[0032] in:

[0033]

[0034] Where m i is the mass of the robot arm connecting rod, T i ∈R 3×3 is the transformation matrix, l n ∈R 3 is the position of the center of gravity of link n relative to the front joint coordinate system.

[0035] In order to achieve faster convergence speed and better tracking performance, the following non-singular terminal sliding surface is designed:

[0036]

[0037] Where α>0, β>0, 1<r2<2, r2<r1, s=[s1,s2,...,s n ] T ∈R n , e1=[e 11 ,e 12 ,...,e 1n ] T ∈R n , e2=[e 21 ,e 22 ,...,e 2n ] T ∈R n ,Ψ1=diag(e 11 ,e 12 ,...,e 1n ), Ψ2=diag(e 21 ,e 22 ,...,e 2n ).

[0038] Assume cumulative uncertainty is bounded. Under the given sliding surface (4), in order to ensure that the system error state e1 converges to zero, the following control law needs to be designed:

[0039] τ=-M(q)(u eq +u sw ) (5)

[0040] in

[0041]

[0042] Where c1, c2 and r3 are designed normal constants, and 0<r3<1. NFTSM can make the system error state converge to zero in a finite time, so it has a faster convergence speed. In addition, it avoids singularity problems, making it very suitable for controlling mobile robotic arms.

[0043] In order to reduce chattering, the saturation function sat(s) is used in the controller to replace the sign function sign(s), where sat(s) is designed as follows:

[0044]

[0045] Where δ>0 is the boundary layer.

[0046] S4: When the base is moving, the NFTSM controller is used to perform stable trajectory tracking control on the mobile robot system.

[0047] To verify the effectiveness of the method proposed in the present invention, a base with six degrees of freedom and a redundant manipulator with seven degrees of freedom are combined into a mobile manipulator system in a simulation environment. The specific experimental process includes: when the base moves, the redundant manipulator end effector needs to track a circular trajectory in a fixed coordinate system. Figure 2 Schematic diagram of a mobile robotic arm tracking a circular trajectory.

[0048] In the simulation, the relevant parameters are set as follows: n = 7, sampling time t = 0.01s, total simulation time T = 10s, and NFTSM related parameters are set as follows: α = 1, β = 1, r1 = 1.8, r2 = 1.6, r3 = 0.8, c1 = 20, c2 = 0.6. The initial joint angle is set to q0 = [0, 0.78, 0, 2.35, 0, 1.57, 0.78] T rad.

[0049] Figure 3The simulation results of trajectory tracking of a mobile manipulator based on NFTSM, (a) is the three-dimensional desired trajectory and actual trajectory, (b) is the two-dimensional actual trajectory and desired trajectory, the dotted line "Actual Trajectory" in the figure represents the actual trajectory of the end effector of the manipulator, and the solid line "Desired Trajectory" represents the desired trajectory of the end effector of the manipulator. It can be seen from the figure that the position tracking error quickly converges to within 0.01 meters. Therefore, the method proposed in the present invention is effective and has high control accuracy.

[0050] In order to further verify the superiority of the proposed method, the proposed method of the present invention is compared with the PID (proportional-integral-differential) and ESO (extended disturbance observer) methods. The specific experimental process is: based on the three control methods, the end effector of the mobile robot arm tracks a circular trajectory, and then the control effects of the three methods are compared to analyze their position errors.

[0051] Figure 4 The control experiment results of the proposed method are compared with those of PID and ESO. (a), (b), and (c) represent the position errors of the end effector of the robot arm in the X, Y, and Z directions, respectively. The dotted line represents the proposed method, the solid line represents the PID method, and the dotted line represents the ESO method. Figure 4 It can be seen that the maximum error of the method proposed in the present invention is smaller than the maximum error of the PID and ESO methods. Therefore, the method proposed in the present invention is superior to the PID and ESO control methods and has certain advantages.

[0052] See also Figure 5 , Figure 5 4 is a schematic diagram of the working of the hardware device of an embodiment of the present invention, wherein the hardware device specifically comprises: a mobile robot arm trajectory tracking control device 401, a processor 402 and a storage device 403.

[0053] A mobile robotic arm trajectory tracking control device 401: The mobile robotic arm trajectory tracking control device 401 implements the mobile robotic arm trajectory tracking control method.

[0054] Processor 402: The processor 402 loads and executes the instructions and data in the storage device 403 to implement the mobile robot arm trajectory tracking control method.

[0055] Storage device 403: The storage device 403 stores instructions and data; the storage device 403 is used to implement the mobile robot arm trajectory tracking control method.

[0056] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

Claims

1. A mobile robot trajectory tracking control method, characterized in that: include: S1: Establish a dynamic model for a mobile robotic arm system, which includes a base and a robotic arm; S2: Define tracking error; S3: Design NFTSM controller: Design a non-singular terminal sliding surface based on the tracking error; Design the control law based on the non-singular terminal sliding surface; S4: When the base is moving, the NFTSM controller is used to perform stable trajectory tracking control on the mobile robot system.

2. A mobile robot arm trajectory tracking control method as claimed in claim 1, characterized in that: In S1, the established kinetic model is: Where q∈R n is the joint angle, is the joint angular velocity, is the joint angular acceleration, R n represents the real number domain, τ is the joint torque input, τ d represents the additional perturbation, τ b Represents the disturbance of the robot arm from the base, M(q)∈R n×n is a positive definite inertia matrix, represents the centrifugal force and the Coriolis matrix, G(q)∈R n×n Represents the gravity vector of the robot arm.

3. A mobile robot arm trajectory tracking control method as claimed in claim 2, characterized in that: In S2, tracking error: e1 = qq d and Among them, q d is the desired joint angle, is the desired joint angular velocity; According to the tracking error, formula (1) can be written as follows: Where e = [e1, e2] T ∈R 2n , is the expected angular acceleration, 4. A mobile robot arm trajectory tracking control method as claimed in claim 2, characterized in that: The disturbance τ of the base on which the robot is subjected b is defined as follows: in: m i is the mass of the robot arm connecting rod, is the acceleration caused by the motion of the base, T i ∈R 3×3 is the transformation matrix, l n ∈R 3 is the position of the center of gravity of the link n relative to the front joint coordinate system, and the superscript T indicates transposition.

5. A mobile robot arm trajectory tracking control method as claimed in claim 3, characterized in that: The designed non-singular terminal sliding surface is: Among them, α>0, β>0, 1<r2<2, r2<r1, s=[s1,s2,...,s n ] T ∈R n , e1=[e 11 ,e 12 ,...,e 1n ] T ∈R n , e2=[e 21 ,e 22 ,...,e 2n ] T ∈R n ,Ψ1=diag(e 11 ,e 12 ,...,e 1n ), Ψ2=diag(e 21 ,e 22 ,...,e 2n ), sat() is the saturation function, and the superscript T indicates the transpose.

6. A mobile robot arm trajectory tracking control method as claimed in claim 5, characterized in that: The control law in S4 is: τ=-M(q)(u eq +u sw ) (5) in: c1, c2 and r3 are all designed normal numbers, and 0<r3<1; In order to reduce chattering, the saturation function sat(s) is used in the controller to replace the sign function sign(s), where sat(s) is designed as follows: Where δ>0 is the boundary layer.

7. A storage device, characterized in that: The storage device stores instructions and data for implementing the mobile robot arm trajectory tracking control method according to any one of claims 1 to 6.

8. A mobile robot arm trajectory tracking control device, characterized in that: include: Processors and storage devices; The processor loads and executes the instructions and data in the storage device to implement the mobile robot arm trajectory tracking control method according to any one of claims 1 to 6.