Self-adaptive AUV trajectory tracking method, device, equipment and storage medium

Abstract

The invention provides a self-adaptive AUV trajectory tracking method, device and equipment and a storage medium, and relates to the technical field of underwater vehicles, and the method comprises the steps: obtaining a kinetic model and a kinematic model of an underwater vehicle; based on a self-adaptive generalized super-spiral sliding mode control algorithm, a self-adaptive disturbance observer is obtained according to the dynamic model and the kinematic model, and the self-adaptive disturbance observer is used for estimating dynamic disturbance and external disturbance; according to the self-adaptive disturbance observer, a self-adaptive self-anti-interference controller is obtained, and the self-adaptive self-anti-interference controller is used for adjusting control parameters of the underwater vehicle in a self-adaptive and self-anti-interference mode; an AUV trajectory tracking strategy is obtained through the self-adaptive self-anti-interference controller, and the AUV trajectory tracking strategy is used for controlling the underwater vehicle to complete a trajectory tracking task according to a preset path. According to the invention, the trajectory tracking precision of the underwater vehicle is improved.

Description

Technical Field

[0001] The present invention relates to the technical field of underwater vehicles, and more particularly, to an adaptive AUV trajectory tracking method, device, equipment, and storage medium. Background Art

[0002] An AUV, that is, an autonomous underwater vehicle, is a robot capable of autonomous navigation underwater. They are commonly used in various applications such as ocean exploration, environmental monitoring, and seabed exploration. AUV trajectory tracking refers to the process of making an AUV navigate along a preset path or a target trajectory adjusted in real time in an underwater environment. Traditional AUV trajectory tracking methods mainly focus on dealing with constant or slowly changing disturbances, and their estimation ability for fast time-varying types of interference is poor, and the AUV trajectory tracking accuracy cannot meet the actual needs. At the same time, due to the large number of control parameters, it is difficult to adjust in practical applications. Summary of the Invention

[0003] The present invention aims to solve at least one of the above problems.

[0004] To solve the above problems, the present invention provides an adaptive AUV trajectory tracking method, device, equipment, and storage medium.

[0005] In a first aspect, the present invention provides an adaptive AUV trajectory tracking method, including: Obtaining the dynamic model and kinematic model of an underwater vehicle; Based on the adaptive generalized super-twisting sliding mode control algorithm, an adaptive disturbance observer is obtained according to the dynamic model and the kinematic model, wherein the adaptive disturbance observer is used to estimate dynamic disturbances and external disturbances; An adaptive active disturbance rejection controller is obtained according to the adaptive disturbance observer, wherein the adaptive active disturbance rejection controller is used to adaptively adjust the control parameters of the underwater vehicle for active disturbance rejection; An AUV trajectory tracking strategy is obtained through the adaptive active disturbance rejection controller, wherein the AUV trajectory tracking strategy is used to control the underwater vehicle to complete the trajectory tracking task according to a preset path.

[0006] Optionally, the obtaining the adaptive disturbance observer according to the dynamic model and the kinematic model includes: The adaptive disturbance observer is obtained according to the dynamic model and the kinematic model, wherein the adaptive disturbance observer is: , wherein, and are the disturbance estimation error and the internal state estimation error respectively, and are the estimated disturbance and the estimated state variable respectively, and are the actual disturbance and the actual state variable respectively, and is the dynamic data of the internal state of the disturbance observer, and are the adaptive gains, and are the auxiliary vectors, and are the functions for disturbance estimation, is the reference input signal.

[0007] Optionally, the adaptive auto-disturbance rejection controller obtained according to the adaptive disturbance observer includes: Obtain the algebraic relationship of the position state through the adaptive disturbance observer, where the algebraic relationship of the position state is: , where, is the disturbance term, is the introduced disturbance function, is the design constant, is the preset control law, is the acceleration of the underwater vehicle, is the velocity of the underwater vehicle in the x direction, is the velocity of the underwater vehicle in the y direction, is the velocity of the underwater vehicle in the z direction, is the heading angle of the underwater vehicle, is the time variable; Obtain the adaptive auto-disturbance rejection controller according to the algebraic relationship of the position state.

[0008] Optionally, the obtaining of the adaptive auto-disturbance rejection controller according to the algebraic relationship of the position state includes: Substitute the preset control law into the algebraic relationship of the position state to obtain the adaptive auto-disturbance rejection controller, where the preset control law is: , where, is the introduced disturbance function, is the design constant, is the preset control law, is the external input.

[0009] Optionally, the substituting of the preset control law into the algebraic relationship of the position state to obtain the adaptive auto-disturbance rejection controller includes: Substitute the preset control law into the algebraic relationship of the position state to obtain the adaptive disturbance rejection controller, where the adaptive disturbance rejection controller is: , where, is the external input, , are respectively , derivatives, , are the state parameters of the underwater vehicle, is the system output.

[0010] Optionally, obtaining the dynamic model and kinematic model of the underwater vehicle includes: Obtain the dynamic model of the underwater vehicle in the vertical plane and horizontal plane, where the dynamic model is: , where m is the mass of the underwater vehicle, , , and are added mass terms of hydrodynamics, , , and are respectively the linear coefficients of surge, sway, heave and yaw, , , and are respectively the quadratic damping coefficients of surge, sway, heave and yaw, , and are the control inputs acting on the underwater vehicle, is the torque affecting the yaw motion, , , and are the forces caused by external disturbances in each direction, , , are respectively the derivatives of u, v, w, where u, v, w are the rotational velocities along the x-axis, y-axis, z-axis directions respectively, and r is the rotational velocity of rotation, is the moment of inertia along the z-axis direction.

[0011] Optionally, obtaining the dynamic model and kinematic model of the underwater vehicle includes: Obtain the kinematic model of the underwater vehicle in the vertical plane and horizontal plane, where the kinematic model is: , wherein, , , are the derivatives of the position coordinates of the underwater vehicle in three-dimensional space, is the derivative of the direction angle of the underwater vehicle, is the velocity component along the forward direction, is the velocity component along the lateral direction, is the velocity component along the up and down direction, is the rotation rate of the underwater vehicle, is the direction angle of the underwater vehicle.

[0012] In a second aspect, the present invention provides an adaptive AUV trajectory tracking device, including: a dynamic model and kinematic model acquisition module for acquiring the dynamic model and kinematic model of an underwater vehicle; an adaptive disturbance observer acquisition module for obtaining an adaptive disturbance observer based on an adaptive generalized super-twisting sliding mode control algorithm according to the dynamic model and the kinematic model, wherein the adaptive disturbance observer is used to estimate dynamic disturbances and external disturbances; an adaptive active disturbance rejection controller acquisition module for obtaining an adaptive active disturbance rejection controller according to the adaptive disturbance observer, wherein the adaptive active disturbance rejection controller is used to adaptively adjust the control parameters of the underwater vehicle; an AUV trajectory tracking strategy acquisition module for obtaining an AUV trajectory tracking strategy through the adaptive active disturbance rejection controller, wherein the AUV trajectory tracking strategy is used to control the underwater vehicle to complete a trajectory tracking task according to a preset path.

[0013] In a third aspect, the present invention provides an electronic device, including a memory and a processor; the memory for storing a computer program; the processor for, when executing the computer program, implementing the adaptive AUV trajectory tracking method as described in the first aspect.

[0014] In a fourth aspect, the present invention provides a computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, the adaptive AUV trajectory tracking method as described in the first aspect is implemented.

[0015] The beneficial effects of the adaptive AUV trajectory tracking method, device, equipment and storage medium of the present invention are as follows: Based on the adaptive generalized super-twisting sliding mode control algorithm, an adaptive disturbance observer is obtained according to the dynamic model and the kinematic model, combining the robustness of sliding mode control and the flexibility of adaptive control, while ensuring the stability of the system, improving its applicability and performance. An adaptive active disturbance rejection controller is obtained according to the adaptive disturbance observer, and the parameters can be adjusted through the adaptive disturbance observer. An AUV trajectory tracking strategy is obtained through the adaptive active disturbance rejection controller, improving the trajectory tracking accuracy, being able to better track the sine trajectory, and being more suitable for practical applications. BRIEF DESCRIPTION OF THE DRAWINGS

[0016] Figure 1 It is a schematic flowchart of an adaptive AUV trajectory tracking method according to an embodiment of the present invention; Figure 2 It is a schematic structural diagram of an adaptive AUV trajectory tracking device according to an embodiment of the present invention; Figure 3 It is a schematic structural diagram of an electronic device according to an embodiment of the present invention. DETAILED DESCRIPTION OF THE EMBODIMENTS

[0017] To make the above objects, features and advantages of the present invention more obvious and understandable, the specific embodiments of the present invention will be described in detail below with reference to the drawings. Although some embodiments of the present invention are shown in the drawings, it should be understood that the present invention can be implemented in various forms and should not be construed as limited to the embodiments set forth herein. On the contrary, these embodiments are provided to more thoroughly and completely understand the present invention. It should be understood that the drawings and embodiments of the present invention are only for exemplary purposes and are not used to limit the protection scope of the present invention.

[0018] It should be understood that the steps recorded in the method embodiments of the present invention can be executed in different orders and / or in parallel. In addition, the method embodiments may include additional steps and / or omit the steps shown. The scope of the present invention is not limited in this regard.

[0019] As used herein, the term "including" and its variants are open-ended, i.e., "including but not limited to"; the term "based on" means "at least partially based on"; the term "one embodiment" means "at least one embodiment"; the term "another embodiment" means "at least one additional embodiment"; the term "some embodiments" means "at least some embodiments"; the term "optionally" means "optional embodiments". The relevant definitions of other terms will be given in the following description. It should be noted that the concepts such as "first", "second", etc. mentioned in the present invention are only used to distinguish different devices, modules or units, and are not used to limit the order or interdependence of the functions performed by these devices, modules or units.

[0020] It should be noted that the modification of "one" and "multiple" mentioned in the present invention is illustrative rather than restrictive. Those skilled in the art should understand that unless otherwise clearly specified in the context, it should be understood as "one or more".

[0021] The names of the messages or information exchanged between multiple devices in the embodiments of the present invention are only for illustrative purposes and are not used to limit the scope of these messages or information.

[0022] In view of the problems existing in the above related technologies, this embodiment provides an adaptive AUV trajectory tracking method, device, equipment and storage medium.

[0023] As Figure 1 shown, an adaptive AUV trajectory tracking method provided by an embodiment of the present invention includes: Step 110, obtaining the dynamic model and kinematic model of the underwater vehicle.

[0024] Specifically, the dynamic model and kinematic model of the underwater vehicle are important bases for understanding its motion behavior. The kinematic model describes how the motion of an object changes over time without considering the cause of the motion, and is used to analyze the changes in position, velocity and attitude. The dynamic model describes the cause of the motion, involves the action of forces and torques, and mainly focuses on the physical characteristics of the underwater vehicle. Among them, the dynamic model is: , where is the time derivative of the state variable, is the position and direction vector relative to the earth-fixed coordinate system, is the velocity state vector relative to the body-fixed coordinate system, is the spatial transformation matrix between the rigid body inertial coordinate system and the rigid body coordinate system.

[0025] Step 120: Based on the adaptive generalized super-twisting sliding mode control algorithm, an adaptive disturbance observer is obtained according to the dynamic model and the kinematic model, where the adaptive disturbance observer is used to estimate the dynamic disturbance and the external disturbance.

[0026] Specifically, the adaptive generalized super-twisting sliding mode control is an advanced control method aimed at overcoming some deficiencies of the traditional sliding mode control and improving the robustness and adaptive ability of the system. An adaptive disturbance observer is obtained according to the dynamic model and the kinematic model. The adaptive disturbance observer is a tool for real-time estimating the unmodeled dynamics and external disturbances in the system, which can effectively improve the robustness of the dynamic system.

[0027] Step 130: An adaptive active disturbance rejection controller is obtained according to the adaptive disturbance observer, where the adaptive active disturbance rejection controller is used to adaptively adjust the control parameters of the underwater vehicle by active disturbance rejection.

[0028] Specifically, for an autonomous underwater vehicle (AUV), based on the obtained adaptive disturbance observer, an adaptive active disturbance rejection controller can be further constructed.

[0029] Step 140: An AUV trajectory tracking strategy is obtained through the adaptive active disturbance rejection controller, where the AUV trajectory tracking strategy is used to control the underwater vehicle to complete the trajectory tracking task according to a preset path.

[0030] Specifically, the adaptive active disturbance rejection controller calculates the control input according to the preset path to generate the necessary propulsion force and angle, so that the underwater vehicle can be adjusted to the preset path.

[0031] In this embodiment, based on the adaptive generalized super-twisting sliding mode control algorithm, an adaptive disturbance observer is obtained according to the dynamic model and the kinematic model, which combines the robustness of the sliding mode control and the flexibility of the adaptive control. While ensuring the stability of the system, it improves its applicability and performance. An adaptive active disturbance rejection controller is obtained according to the adaptive disturbance observer, and the parameters can be adjusted through the adaptive disturbance observer. An AUV trajectory tracking strategy is obtained through the adaptive active disturbance rejection controller, which improves the trajectory tracking accuracy, can better track the sine trajectory, and is more suitable for practical applications.

[0032] Optionally, the obtaining of the adaptive disturbance observer according to the dynamic model and the kinematic model includes: The adaptive disturbance observer is obtained according to the dynamic model and the kinematic model, where the adaptive disturbance observer is: , wherein, and are the disturbance estimation error and the internal state estimation error respectively, and are the estimated disturbance and the estimated state variable respectively, and are the actual disturbance and the actual state variable respectively, and are the dynamic data of the internal state of the disturbance observer, and are the adaptive gains, and are the auxiliary vectors, and are the functions for disturbance estimation, is the reference input signal.

[0033] Specifically, wherein, the appropriate variables are selected as: .

[0034] wherein, is the position state of the AUV, is the derivative of, and are variables, and the following algebraic relationship is obtained from the above formula: , wherein: , wherein, is the derivative of the position state of the AUV with respect to time, is the mass matrix, is the torque vector of gravity and buoyancy, is the Jacobian matrix for describing the relationship between the system state and the control input, is the attitude of the underwater vehicle for describing the mass distribution of the system, is the external disturbance or input signal of the system.

[0035] wherein, in order to design an adaptive disturbance observer to estimate the bounded disturbance, we introduce the auxiliary variable as: , wherein, and are diagonal positive definite matrices. It should be noted that when is satisfied, this term modifies the convergence speed to the origin.

[0036] Among them, the time derivative of the auxiliary variable is: , where , is the reference input signal.

[0037] Among them, according to the experimental design purpose, we regard the disturbance term as the extended state : , where is the total disturbance of the time derivative.

[0038] Among them, the adaptive disturbance observer is: , where and are the disturbance estimation error and the internal state estimation error respectively, and are the estimated disturbance and the estimated state variable respectively, and are the actual disturbance and the actual state variable respectively, and are the dynamics of the internal state of the disturbance observer, and are the adaptive gains, and are the auxiliary vectors, and are the functions for disturbance estimation, is the reference input signal.

[0039] Among them, each element in the vectors and is: , where is the state variable, is the coefficient for adjusting the overall dynamic influence, The symbolic operation relationship existing in is defined as , , and are the constant controller gains.

[0040] Among them, the sgn sign function is: , where is a scalar.

[0041] Among them, the adaptive gain and are determined according to the following update rules: , wherein, , , and are constants.

[0042] Among them, a small boundary is introduced for , and the adaptive gain is: , wherein, is a small, empirically selected constant, and the purpose of this boundary is to prevent the adaptive gain from increasing to infinity. Because in practice the auxiliary variable can never be exactly zero, making the second condition of the adaptive gain never satisfied, so it is necessary to limit the auxiliary variable .

[0043] In this alternative embodiment, an adaptive disturbance observer is designed according to the above model to estimate the external disturbance, combining the robustness of sliding mode control and the flexibility of adaptive control, improving its applicability and performance while ensuring the stability of the system.

[0044] Optionally, the adaptive auto-disturbance rejection controller obtained according to the adaptive disturbance observer includes: An algebraic relationship of the position state is obtained through the adaptive disturbance observer, wherein the algebraic relationship of the position state is: , wherein, is the disturbance term, is the introduced disturbance function, is the design constant, is the preset control law, is the acceleration of the underwater vehicle, is the velocity of the underwater vehicle in the x direction, is the velocity of the underwater vehicle in the y direction, is the velocity of the underwater vehicle in the z direction, is the heading angle of the underwater vehicle, is the time variable; The adaptive auto-disturbance rejection controller is obtained according to the algebraic relationship of the position state.

[0045] Specifically, after combining the algebraic relationships of the AUV position states, it can be expressed as: , wherein, is the disturbance term.

[0046] The introduced disturbance function , and the algebraic relationship of the position state is: , wherein, is the disturbance term, is the introduced disturbance function, is the design constant, is the preset control law, is the acceleration of the underwater vehicle, is the velocity of the underwater vehicle in the x direction, is the velocity of the underwater vehicle in the y direction, is the velocity of the underwater vehicle in the z direction, is the heading angle of the underwater vehicle, is the time variable.

[0047] wherein, and .

[0048] Optionally, obtaining the adaptive active disturbance rejection controller according to the algebraic relationship of the position state includes: Substituting the preset control law into the algebraic relationship of the position state to obtain the adaptive active disturbance rejection controller, wherein the preset control law is: , wherein, is the introduced disturbance function, is the design constant, is the preset control law, is the external input.

[0049] Optionally, substituting the preset control law into the algebraic relationship of the position state to obtain the adaptive active disturbance rejection controller includes: Substituting the preset control law into the algebraic relationship of the position state to obtain the adaptive active disturbance rejection controller, wherein the adaptive active disturbance rejection controller is: , wherein, is the external input, , are respectively , derivatives, , are the state parameters of the underwater vehicle, is the system output.

[0050] Specifically, substituting the preset control law into the algebraic relationship of the position state gives: .

[0051] Among them, the system relationship can be expressed as: , Among them, , by setting the controller gains and the system can reach Hurwitz stability.

[0052] In this optional embodiment, an adaptive disturbance observer is used to obtain an adaptive active disturbance rejection controller, and the parameters can be adjusted through the adaptive disturbance observer.

[0053] Optionally, obtaining the dynamic model and kinematic model of the underwater vehicle includes: Obtaining the dynamic models of the underwater vehicle in the vertical plane and the horizontal plane, where the dynamic model is: , where m is the mass of the underwater vehicle, , , and are the added mass terms of hydrodynamics, , , and are the linear coefficients of surge, sway, heave, and yaw respectively, , , and are the quadratic damping coefficients of surge, sway, heave, and yaw respectively, , and are the control inputs acting on the underwater vehicle, is the torque affecting the yaw motion, , , and are the forces caused by external disturbances in each direction, , , are the derivatives of u, v, w respectively, u, v, w are the rotational velocities along the x-axis, y-axis, and z-axis directions respectively, and r is the rotational velocity of rotation, is the moment of inertia along the z-axis direction.

[0054] Optionally, obtaining the dynamic model and kinematic model of the underwater vehicle includes: Obtaining the kinematic models of the underwater vehicle in the vertical plane and the horizontal plane, where the kinematic models are: , where , , are the derivatives of the position coordinates of the underwater vehicle in three-dimensional space, is the derivative of the direction angle of the underwater vehicle, is the velocity component along the forward direction, is the velocity component along the lateral direction, is the velocity component along the up and down direction, is the rotation rate of the underwater vehicle, is the direction angle of the underwater vehicle.

[0055] Specifically, where the dynamic model is: , where is the time derivative of the state variable, is the position and orientation vector relative to the earth-fixed coordinate system, is the velocity state vector relative to the body-fixed coordinate system, is the spatial transformation matrix between the rigid body inertial coordinate system and the rigid body coordinate system. u, v, and w are the rotational velocities along the x-axis, y-axis, and z-axis directions respectively.

[0056] Assume that the AUV is symmetric in the XZ and YZ planes, moves at a low speed, and is inherently stable in the pitch angle and roll directions. Where the simplified kinematic model is: , where , , are the derivatives of the position coordinates of the underwater vehicle in three-dimensional space, is the derivative of the direction angle of the underwater vehicle, is the velocity component along the forward direction, is the velocity component along the lateral direction, is the velocity component along the up and down direction, is the rotation rate of the underwater vehicle, is the direction angle of the underwater vehicle.

[0057] The simplified four-degree-of-freedom dynamic model is: , wherein, is the inertia matrix and includes the influence of added mass, is the Coriolis centripetal matrix, is the hydrodynamic damping matrix, is the vector of gravity, buoyancy and moment, is the control vector affecting the underwater vehicle, is the bounded disturbance.

[0058] After arrangement, the specific dynamic model is obtained as: , wherein, m is the mass of the underwater vehicle, , , and are the hydrodynamic added mass terms, , , and are the linear coefficients of surge, sway, heave and yaw respectively, , , and are the quadratic damping coefficients of surge, sway, heave and yaw respectively, , and are the control inputs acting on the underwater vehicle, is the torque affecting the yaw motion, , , and are the forces caused by external disturbances in each direction, , , are the derivatives of u, v, w respectively, u, v, w are the rotational velocities along the x-axis, y-axis and z-axis directions respectively, and r is the rotational velocity of rotation, is the moment of inertia along the z-axis direction.

[0059] For the convenience of subsequent research, the above parameters are integrated and simplified, and it is expressed as: .

[0060] The four-degree-of-freedom dynamic model of the AUV is: .

[0061] Introduce the auxiliary variables and , and after integrating the dynamic model with the auxiliary variables, it is: , wherein, is the mass matrix, is in the form of a control input vector, is the vector definition of external disturbances.

[0062] Among them, the matrix is expressed as: .

[0063] Among them, some parameters are defined as: .

[0064] As Figure 2 shown, an adaptive AUV trajectory tracking device provided by an embodiment of the present invention includes: A dynamics model and kinematics model acquisition module 10, configured to acquire a dynamics model and a kinematics model of an underwater vehicle; An adaptive disturbance observer acquisition module 20, configured to obtain an adaptive disturbance observer based on an adaptive generalized super-twisting sliding mode control algorithm according to the dynamics model and the kinematics model, wherein the adaptive disturbance observer is used to estimate dynamic disturbances and external disturbances; An adaptive active disturbance rejection controller acquisition module 30, configured to obtain an adaptive active disturbance rejection controller according to the adaptive disturbance observer, wherein the adaptive active disturbance rejection controller is used to adaptively adjust control parameters of the underwater vehicle; An AUV trajectory tracking strategy acquisition module 40, configured to obtain an AUV trajectory tracking strategy through the adaptive active disturbance rejection controller, wherein the AUV trajectory tracking strategy is used to control the underwater vehicle to complete a trajectory tracking task according to a preset path.

[0065] The adaptive AUV trajectory tracking device of this embodiment is used to implement the above-mentioned adaptive AUV trajectory tracking method, and its advantages compared with the prior art are the same as those of the above-mentioned adaptive AUV trajectory tracking method compared with the prior art, and will not be elaborated here.

[0066] Optionally, the adaptive disturbance observer acquisition module 20 is specifically configured to: obtain the adaptive disturbance observer according to the dynamics model and the kinematics model, wherein the adaptive disturbance observer is: , wherein, and are respectively the disturbance estimation error and the internal state estimation error, and are respectively the estimated disturbance and the estimated state variable, and are the actual disturbance and the actual state variable respectively, and are the dynamic data of the internal state of the disturbance observer, and are the adaptive gains, and are the auxiliary vectors, and are the functions for disturbance estimation, is the reference input signal.

[0067] Optionally, the adaptive active disturbance rejection controller obtaining module 30 is specifically configured to: obtain the algebraic relationship of the position state through the adaptive disturbance observer, where the algebraic relationship of the position state is: , wherein, is the disturbance term, is the introduced disturbance function, is the design constant, is the preset control law, is the acceleration of the underwater vehicle, is the velocity of the underwater vehicle in the x direction, is the velocity of the underwater vehicle in the y direction, is the velocity of the underwater vehicle in the z direction, is the heading angle of the underwater vehicle, is the time variable; Obtain the adaptive active disturbance rejection controller according to the algebraic relationship of the position state.

[0068] Optionally, the adaptive active disturbance rejection controller obtaining module 30 is specifically configured to: substitute the preset control law into the algebraic relationship of the position state to obtain the adaptive active disturbance rejection controller, where the preset control law is: , wherein, is the introduced disturbance function, is the design constant, is the preset control law, is the external input.

[0069] Optionally, the adaptive active disturbance rejection controller obtaining module 30 is specifically configured to: substitute the preset control law into the algebraic relationship of the position state to obtain the adaptive active disturbance rejection controller, where the adaptive active disturbance rejection controller is: , wherein, is the external input, , are respectively , derivatives, , are the state parameters of the underwater vehicle, is the system output.

[0070] Optionally, the dynamic model and kinematic model acquisition module 10 is specifically configured to: acquire the dynamic models of the underwater vehicle in the vertical plane and the horizontal plane, where the dynamic model is: , where m is the mass of the underwater vehicle, , , and are added mass terms of hydrodynamics, , , and are respectively the linear coefficients of surge, sway, heave, and yaw, , , and are respectively the quadratic damping coefficients of surge, sway, heave, and yaw, , and are the control inputs acting on the underwater vehicle, is the torque affecting the yaw motion, , , and are the forces caused by external disturbances in each direction, , , are respectively the derivatives of u, v, w, where u, v, w are the rotational velocities along the x-axis, y-axis, and z-axis directions, and r is the rotational velocity of rotation, is the moment of inertia along the z-axis direction.

[0071] Optionally, the dynamic model and kinematic model acquisition module 10 is specifically configured to: acquire the kinematic models of the underwater vehicle in the vertical plane and the horizontal plane, where the kinematic model is: , where, , , are the derivatives of the position coordinates of the underwater vehicle in three-dimensional space, is the derivative of the direction angle of the underwater vehicle, is the velocity component along the forward direction, is the velocity component along the lateral direction, is the velocity component along the up - down direction, is the rotation rate of the underwater vehicle, is the direction angle of the underwater vehicle.

[0072] As Figure 3 shown, an electronic device 300 provided by an embodiment of the present invention includes a memory 310 and a processor 320; the memory 310 is used to store a computer program; the processor 320 is used to implement the adaptive AUV trajectory tracking method as described above when executing the computer program.

[0073] Or rather, an electronic device 300 includes a memory 310 and a processor 320 coupled to the memory 310; the memory 310 is configured to store a computer program; the processor 320 is configured to perform the following operations when executing the computer program: Obtain the dynamic model and kinematic model of the underwater vehicle; Based on the adaptive generalized super - twisting sliding - mode control algorithm, obtain an adaptive disturbance observer according to the dynamic model and the kinematic model, where the adaptive disturbance observer is used to estimate dynamic disturbances and external disturbances; Obtain an adaptive active disturbance rejection controller according to the adaptive disturbance observer, where the adaptive active disturbance rejection controller is used to adaptively adjust the control parameters of the underwater vehicle for active disturbance rejection; Obtain an AUV trajectory tracking strategy through the adaptive active disturbance rejection controller, where the AUV trajectory tracking strategy is used to control the underwater vehicle to complete the trajectory tracking task according to a preset path.

[0074] A computer - readable storage medium provided by an embodiment of the present invention has a computer program stored thereon, and when the computer program is executed by a processor, the adaptive AUV trajectory tracking method as described above is implemented.

[0075] Or rather, a non - volatile computer - readable storage medium has a computer program stored thereon, and when the computer program is executed by a processor, the processor is caused to perform the following operations: Obtain the dynamic model and kinematic model of the underwater vehicle; Based on the adaptive generalized super - twisting sliding - mode control algorithm, obtain an adaptive disturbance observer according to the dynamic model and the kinematic model, where the adaptive disturbance observer is used to estimate dynamic disturbances and external disturbances; An adaptive auto-disturbance rejection controller is obtained according to the adaptive disturbance observer, wherein the adaptive auto-disturbance rejection controller is used to adaptively adjust the control parameters of the underwater vehicle by auto-disturbance rejection. An AUV trajectory tracking strategy is obtained through the adaptive auto-disturbance rejection controller, wherein the AUV trajectory tracking strategy is used to control the underwater vehicle to complete the trajectory tracking task according to a preset path.

[0076] Now, an electronic device 300 that can be used as a server or a client of the present invention will be described. It is an example of a hardware device that can be applied to various aspects of the present invention. The electronic device 300 is intended to represent various forms of digital electronic computer devices, such as laptop computers, desktop computers, workstations, personal digital assistants, servers, blade servers, mainframe computers, and other suitable computers. The electronic device 300 can also represent various forms of mobile devices, such as personal digital processors, cellular phones, smart phones, wearable devices, and other similar computing devices. The components shown herein, their connections and relationships, and their functions are merely examples and are not intended to limit the implementation of the present invention described herein and / or claimed.

[0077] The electronic device 300 includes a computing unit that can perform various appropriate actions and processes according to a computer program stored in a read-only memory (ROM) or a computer program loaded from a storage unit into a random access memory (RAM). In the RAM, various programs and data required for device operation can also be stored. The computing unit, the ROM, and the RAM are connected to each other through a bus. An input / output (I / O) interface is also connected to the bus.

[0078] Those of ordinary skill in the art can understand that all or part of the processes in the methods of the above embodiments can be completed by instructing relevant hardware through a computer program. The program can be stored in a computer-readable storage medium. When the program is executed, it can include the processes of the embodiments of the above methods. Among them, the storage medium can be a magnetic disk, an optical disk, a read-only memory (ROM), or a random access memory (RAM), etc. In this application, the units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they can be located in one place or distributed to multiple network units. Some or all of the units can be selected according to actual needs to achieve the purpose of the solution of the embodiments of the present invention. In addition, the functional units in each embodiment of the present invention can be integrated in a processing unit, or each unit can exist physically alone, or two or more units can be integrated in one unit. The above integrated units can be implemented in the form of hardware or in the form of software functional units.

[0079] Although the present invention is disclosed as above, the scope of protection of the present invention is not limited thereto. Those skilled in the art can make various changes and modifications without departing from the spirit and scope of the present invention, and these changes and modifications will all fall within the scope of protection of the present invention.

Claims

1. An adaptive AUV trajectory tracking method, characterized in that: include: Obtain the dynamic model and kinematic model of the underwater vehicle; Based on an adaptive generalized super-helical sliding mode control algorithm, an adaptive disturbance observer is obtained according to the dynamic model and the kinematic model, wherein the adaptive disturbance observer is used to estimate dynamic disturbances and external disturbances; Obtaining an adaptive anti-interference controller according to the adaptive disturbance observer, wherein the adaptive anti-interference controller is used to adaptively adjust the control parameters of the underwater vehicle by anti-interference; The AUV trajectory tracking strategy is obtained through the adaptive anti-interference controller, wherein the AUV trajectory tracking strategy is used to control the underwater vehicle to complete the trajectory tracking task according to a preset path.

2. The adaptive AUV trajectory tracking method according to claim 1, characterized in that: The step of obtaining an adaptive disturbance observer according to the dynamic model and the kinematic model comprises: The adaptive disturbance observer is obtained according to the dynamic model and the kinematic model, wherein the adaptive disturbance observer is: ， in, and are the disturbance estimation error and the internal state estimation error, respectively. and are the estimated disturbance and estimated state variables, respectively. and are the actual disturbance and the actual state variable, respectively, and is the dynamic data of the internal state of the disturbance observer, and is the adaptive gain, and is the auxiliary vector, and is the function used for disturbance estimation, is the reference input signal.

3. The adaptive AUV trajectory tracking method according to claim 1, characterized in that: The method of obtaining an adaptive anti-interference controller according to the adaptive disturbance observer comprises: The algebraic relationship of the position state is obtained by the adaptive disturbance observer, wherein the algebraic relationship of the position state is: ， in, is the disturbance term, is the introduced perturbation function, is the design constant, To preset the control law, is the acceleration of the underwater vehicle, is the speed of the underwater vehicle in the x direction, is the speed of the underwater vehicle in the y direction, is the speed of the underwater vehicle in the z direction, is the heading angle of the underwater vehicle, is the time variable; The adaptive anti-interference controller is obtained according to the algebraic relationship of the position state.

4. The adaptive AUV trajectory tracking method according to claim 3, characterized in that: The step of obtaining the adaptive anti-interference controller according to the algebraic relationship of the position state comprises: Substituting the preset control law into the algebraic relationship of the position state, the adaptive anti-interference controller is obtained, wherein the preset control law is: ， in, is the introduced perturbation function, is the design constant, is the preset control law, For external input.

5. The adaptive AUV trajectory tracking method according to claim 4, characterized in that: Substituting the preset control law into the algebraic relationship of the position state to obtain the adaptive anti-interference controller includes: Substituting the preset control law into the algebraic relationship of the position state, the adaptive anti-interference controller is obtained, wherein the adaptive anti-interference controller is: ， in, For external input, , They are , The derivative of , is the state parameter of the underwater vehicle, Output for the system.

6. The adaptive AUV trajectory tracking method according to claim 1, characterized in that: The obtaining of the dynamic model and kinematic model of the underwater vehicle comprises: Obtain the dynamic model of the underwater vehicle in the vertical plane and the horizontal plane, wherein the dynamic model is: ， Wherein, m is the mass of the underwater vehicle, , , and is the additional mass term for fluid mechanics, , , and are the linear coefficients of surge, sway, heave and yaw, , , and are the secondary damping coefficients for surge, sway, heave and yaw, , and is a control input acting on the underwater vehicle, is the torque affecting the yaw motion, , , and is the force caused by the external disturbance in each direction, , , are the derivatives of u, v, and w, respectively. u, v, and w are the rotation speeds along the x-axis, y-axis, and z-axis respectively. r is the rotation speed of the rotation. is the moment of inertia along the z-axis.

7. The adaptive AUV trajectory tracking method according to claim 6, characterized in that: The obtaining of the dynamic model and kinematic model of the underwater vehicle comprises: Obtain the kinematic model of the underwater vehicle in the vertical plane and the horizontal plane, wherein the kinematic model is: ， in, , , is the derivative of the position coordinates of the underwater vehicle in three-dimensional space, is the derivative of the azimuth angle of the underwater vehicle, is the velocity component along the forward direction, is the velocity component along the lateral direction, is the velocity component along the ascending and descending directions, is the rotation rate of the underwater vehicle, is the direction angle of the underwater vehicle.

8. An adaptive AUV trajectory tracking device, characterized in that: include: A dynamic model and kinematic model acquisition module, used to acquire the dynamic model and kinematic model of the underwater vehicle; An adaptive disturbance observer acquisition module is used to obtain an adaptive disturbance observer according to the dynamic model and the kinematic model based on an adaptive generalized super-helical sliding mode control algorithm, wherein the adaptive disturbance observer is used to estimate dynamic disturbances and external disturbances; An adaptive anti-interference controller acquisition module is used to obtain an adaptive anti-interference controller according to the adaptive disturbance observer, wherein the adaptive anti-interference controller is used to adaptively adjust the control parameters of the underwater vehicle by adaptive anti-interference; The AUV trajectory tracking strategy acquisition module is used to obtain the AUV trajectory tracking strategy through the adaptive anti-interference controller, wherein the AUV trajectory tracking strategy is used to control the underwater vehicle to complete the trajectory tracking task according to a preset path.

9. An electronic device, characterized in that: including memory and processor; The memory is used to store computer programs; The processor is used to implement the adaptive AUV trajectory tracking method according to any one of claims 1 to 7 when executing the computer program.

10. A computer-readable storage medium, characterized in that: The storage medium stores a computer program, and when the computer program is executed by a processor, the adaptive AUV trajectory tracking method according to any one of claims 1 to 7 is implemented.

Images