Dual-loop LQR robust depth tracking control method and system for underactuated underwater vehicle

By adopting the dual-loop LQR robust depth tracking control method, the underactuated characteristics and complex disturbances of underwater vehicles are overcome, and high-precision depth tracking control is achieved. This solves the problems of complex control algorithms and insufficient accuracy in existing technologies, and is suitable for engineering applications of underwater vehicles.

CN118502235BActive Publication Date: 2024-11-01HUAZHONG UNIV OF SCI & TECH
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410272447.8
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-03-11
Publication Date
2024-11-01
Estimated Expiration
2044-03-11

AI Technical Summary

Technical Problem

When existing underwater vehicles perform depth tracking tasks in complex marine environments, their control algorithms are complex, which is not conducive to practical engineering applications, and their depth control accuracy is insufficient.

Method used

A robust depth tracking control method with dual-loop LQR is adopted for underactuated underwater vehicles. The outer loop is designed with an adaptive line-of-sight guidance law to overcome the underactuated characteristics and compensate for kinematic disturbances, while the inner loop is designed with an LQR pitch tracking control law and combined with an extended state observer to estimate dynamic disturbances, thus realizing a two-layer control architecture.

Benefits of technology

It improves the anti-interference capability and tracking accuracy of underwater vehicles, ensures robust depth tracking control performance in complex environments, and facilitates engineering practice applications.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118502235B_ABST
    Figure CN118502235B_ABST
Patent Text Reader

Abstract

The present application belongs to the field of underwater vehicle control, and specifically discloses a dual-loop LQR robust depth tracking control method and system for an underactuated underwater vehicle, the method comprising: obtaining the control target and state parameters of the underwater vehicle; the control target comprises: the expected depth; the state parameters comprise: the real-time depth, the real-time speed, the real-time pitch angle, and the real-time pitch angular velocity; determining the depth error corresponding to the expected depth and the real-time depth, and then designing an adaptive line-of-sight angle guidance law based on the depth error and the real-time speed to obtain the expected pitch angle of the underwater vehicle; designing an LQR pitch tracking control law in combination with the observed dynamic disturbance of the underwater vehicle and the expected pitch angle to obtain the rudder angle of the underwater vehicle; and controlling the elevator of the underwater vehicle based on the rudder angle. Through the present application, a dual-loop depth control architecture of an underactuated underwater vehicle is realized, the two loops are tightly coupled, and the control architecture is simple, which is convenient for engineering practice and application.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application belongs to the field of underwater vehicle control, and more specifically, to a robust depth tracking control method and system of a dual-loop linear quadratic regulator (LQR) for an underactuated underwater vehicle. Background Art

[0002] An underwater vehicle is an unmanned underwater vehicle that has a high degree of autonomous navigation capabilities and can carry its own energy and various mission payloads. The basic requirements of an underwater vehicle include the ability to track a predetermined course or depth by effectively controlling its position and attitude. These aspects are essential to maintaining underwater stability and ensuring precise navigation.

[0003] In recent years, the depth control of underwater vehicles has attracted extensive attention from scholars at home and abroad. Based on nonlinear and intelligent control theory, various controllers have been proposed. However, model-based control methods require high-precision models to ensure control accuracy, while model-free control methods require a large amount of data for training. In addition, as the control algorithm becomes more and more complex, more control parameters usually need to be considered, which makes engineering applications very complicated. Therefore, it is particularly important to design a control algorithm with a simple form and good robustness. By gradually eliminating external interference and internal model uncertainty in the motion loop and dynamic loop, the external interference and internal model uncertainty are systematically solved, which is conducive to future deployment and engineering applications in actual marine environments. Summary of the invention

[0004] In view of the defects of the prior art, the purpose of the present application is to provide a dual-loop LQR robust depth tracking control method and system for an underactuated underwater vehicle, aiming to solve the problem that the existing control algorithm is complex in structure and not conducive to deployment and application in actual engineering when the underwater vehicle performs high-precision depth tracking operations in a marine environment with complex interference.

[0005] To achieve the above objectives, in a first aspect, the present application provides a dual-loop LQR robust depth tracking control method for an underactuated underwater vehicle, comprising:

[0006] Acquire the control target and state parameters of the underwater vehicle; the control target includes: expected depth; the state parameters include: real-time depth, real-time speed, real-time pitch angle and real-time pitch angle speed;

[0007] Determining a depth error between the desired depth and the real-time depth, and then designing an adaptive line-of-sight angle guidance law based on the depth error and the real-time speed to obtain a desired pitch angle of the underwater vehicle;

[0008] Designing a linear quadratic regulator LQR pitch tracking control law based on the observed dynamic disturbance of the underwater vehicle and the desired pitch angle to obtain the rudder angle of the underwater vehicle;

[0009] The elevator of the underwater vehicle is controlled based on the rudder angle so that the underwater vehicle navigates at the desired depth.

[0010] It should be noted that the present application divides the complex disturbances to which the underwater vehicle is subjected into a kinematic loop and a dynamic loop, and designs control laws in the two loops to resist external complex interference. Among them, the outer kinematic loop mainly overcomes the under-actuated characteristics of the hull through the designed adaptive line of sight angle guidance law, and compensates for the kinematic disturbance caused by the unknown angle of attack; the inner dynamic loop first uses an extended state observer to estimate the external disturbance, and then controls the elevator mechanism of the vehicle through the designed LQR controller to resist external environmental interference. The design of the above-mentioned two-layer control architecture solves the problem of insufficient depth control accuracy in complex environments when using conventional single-loop control.

[0011] It is understandable that the stability of the inner loop is the basis of the stability of the outer loop. When the stability of the inner loop is guaranteed, the stability of the outer loop ensures the stability of the overall system. Specifically, the kinematic outer loop inputs the calculated expected pitch angle into the dynamic inner loop as the tracking target of the inner loop according to the real-time depth error of the underwater vehicle, and the dynamic inner loop subtracts the obtained expected pitch angle from the real-time attitude of the hull, controls the elevator rudder angle through the obtained error, and then adjusts its own attitude to track the expected pitch angle of the outer loop kinematics, and indirectly controls the depth by controlling the pitch angle. In addition, the inner and outer loops respectively compensate and estimate the kinematic disturbance caused by the unknown angle of attack and the complex dynamic disturbance caused by the external environment, thereby realizing robust depth tracking control of the underwater vehicle.

[0012] In a possible implementation, the LQR pitch tracking control law is designed in combination with the observed dynamic disturbance of the underwater vehicle and the desired pitch angle, specifically:

[0013] Determine a state matrix according to the real-time pitch angular velocity and the real-time pitch angle error; the real-time pitch angle error is determined based on the difference between the expected pitch angle and the real-time pitch angle;

[0014] The rudder angle of the underwater vehicle at the current moment is calculated based on the state matrix, the control matrix related to the underwater vehicle rudder efficiency coefficient, the supplementary matrix related to the expected pitch angle and dynamic disturbance, and the feedback gain matrix.

[0015] In a possible implementation, the adaptive sight angle guidance law includes the following formula:

[0016]

[0017]

[0018] Among them, z e is the depth error, Δ is the foresight distance, θ d is the desired pitch angle, is the estimated real-time angle of attack, is the first-order differential of the estimated real-time angle of attack, and γ is an adaptive parameter.

[0019] In a possible implementation, the LQR pitch tracking control law includes the following formula:

[0020] u0=-Kx-B -1 F

[0021] Where u0 represents the rudder angle calculated at the current moment, x represents the state matrix, x = [q θ e ] T , q is the real-time pitch angular velocity, θ e is the desired pitch angle θ d The pitch angle error between the real-time pitch angle θ, B = [b0 0] T is the control matrix, b0 represents the rudder efficiency coefficient of the underwater vehicle, is the compensation matrix, is the first-order differential of the desired pitch angle, represents the dynamic disturbance, and K is the feedback gain matrix.

[0022] In one possible implementation, the dynamic disturbance Calculated by the following formula:

[0023]

[0024] Where L represents the gain matrix of the observer used to obtain the pitch angle observation value and the pitch angular velocity observation value, is the state estimation matrix, represents the observed value of the pitch angle, represents the observed value of the pitch angular velocity, B0=[0 b0 0] T , δ s Indicates the rudder angle calculated at the last moment, Y = [θ q] T .

[0025] In a possible implementation, the feedback gain matrix K is calculated by the following formula:

[0026] K=R -1 B T P

[0027] A T P+PA-PBR -1 B T P+Q=0

[0028] in, Q and R are preset weight coefficient matrices, and P is a semi-positive definite matrix.

[0029] In a second aspect, the present application provides a dual-loop LQR robust depth tracking control system for an underactuated underwater vehicle, comprising:

[0030] A parameter acquisition unit, used to acquire a control target and state parameters of the underwater vehicle; the control target includes: a desired depth; the state parameters include: a real-time depth, a real-time speed, a real-time pitch angle, and a real-time pitch angle speed;

[0031] an outer loop control unit, configured to determine a depth error between the desired depth and the real-time depth, and then design an adaptive sight angle guidance law based on the depth error and the real-time speed to obtain a desired pitch angle of the underwater vehicle;

[0032] An inner loop control unit is used to design a linear quadratic regulator LQR pitch tracking control law based on the observed dynamic disturbance of the underwater vehicle and the desired pitch angle to obtain the rudder angle of the underwater vehicle;

[0033] The vehicle control unit is used to control the elevator of the underwater vehicle based on the rudder angle so that the underwater vehicle navigates at the desired depth.

[0034] In a possible implementation, the inner loop control unit determines a state matrix based on the real-time pitch angular velocity and the real-time pitch angle error; the real-time pitch angle error is determined based on the difference between the expected pitch angle and the real-time pitch angle; and calculates the rudder angle of the underwater vehicle at the current moment based on the state matrix, a control matrix related to the rudder efficiency coefficient of the underwater vehicle, a supplementary matrix related to the expected pitch angle and dynamic disturbance, and a feedback gain matrix.

[0035] In a third aspect, the present application provides an electronic device comprising: at least one memory for storing programs; and at least one processor for executing the programs stored in the memory. When the program stored in the memory is executed, the processor is used to execute the method described in the first aspect or any possible implementation of the first aspect.

[0036] In a fourth aspect, the present application provides a computer-readable storage medium, which stores a computer program. When the computer program runs on a processor, the processor executes the method described in the first aspect or any possible implementation of the first aspect.

[0037] In a fifth aspect, the present application provides a computer program product. When the computer program product runs on a processor, the processor executes the method described in the first aspect or any possible implementation of the first aspect.

[0038] It can be understood that the beneficial effects of the second to fifth aspects mentioned above can be found in the relevant description of the first aspect mentioned above, and will not be repeated here.

[0039] In general, the above technical solutions conceived by this application have the following beneficial effects compared with the prior art:

[0040] The present application provides a dual-loop LQR robust depth tracking control method and system for an underactuated underwater vehicle, which divides the complex interference to the vehicle into outer-loop kinematic interference and inner-loop dynamic interference, providing an architectural support for subsequent depth stability control; subsequently, an adaptive line-of-sight angle guidance law is designed in the outer loop to overcome the underactuated characteristics, convert the depth tracking error into the desired pitch, and compensate for the kinematic interference caused by the unknown angle of attack; secondly, a simplified LQR method is designed in the inner loop based on the linear model of pitch motion to track the desired pitch, and an extended state observer is introduced to estimate the dynamic interference such as model nonlinearity, uncertainty, and external environment and compensate for it in the control law; finally, the above control algorithm is deployed on the onboard controller, and the elevator angle of the underwater vehicle is controlled by reading the real-time depth and attitude information fed back by the onboard sensor, so as to realize the dual-loop control architecture and ensure that the underwater vehicle performs the deep tracking task. The dual-loop depth control architecture of the underactuated underwater vehicle provided in the present application has two tightly coupled loops, and the control architecture is simple, which is convenient for engineering practice and application. The anti-interference capability and tracking accuracy of the underwater vehicle are improved, ensuring the robust control effect of the underwater vehicle in performing deep tracking tasks. BRIEF DESCRIPTION OF THE DRAWINGS

[0041] Figure 1 is a flow chart of a dual-loop LQR robust depth tracking control method for an underactuated underwater vehicle provided in an embodiment of the present application;

[0042] Figure 2 is a block diagram of a method for controlling the depth of an underwater vehicle provided in an embodiment of the present application;

[0043] Figure 3 is a diagram of a test scenario of an underwater vehicle provided in an embodiment of the present application;

[0044] Figure 4 It is a water pool test depth curve provided in the embodiment of the present application;

[0045] Figure 5 It is a graph of the trim and observed trim of the tank test provided in the embodiment of the present application;

[0046] Figure 6 is a graph of the pitch angular velocity and the observed pitch angular velocity of the water tank test provided in the embodiment of the present application;

[0047] Figure 7 is a curve diagram of the angle of attack estimation of the water tank test provided in the embodiment of the present application;

[0048] Figure 8 It is an architecture diagram of a dual-loop LQR robust depth tracking control system for an underactuated underwater vehicle provided in an embodiment of the present application;

[0049] Fig. 9 It is an architectural diagram of an electronic device provided in an embodiment of the present application. DETAILED DESCRIPTION

[0050] In order to make the purpose, technical solution and advantages of the present application more clearly understood, the present application is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present application and are not used to limit the present application.

[0051] In the embodiments of the present application, words such as "exemplary" or "for example" are used to indicate examples, illustrations or descriptions. Any embodiment or design described as "exemplary" or "for example" in the embodiments of the present application should not be interpreted as being more preferred or more advantageous than other embodiments or designs. Specifically, the use of words such as "exemplary" or "for example" is intended to present related concepts in a specific way.

[0052] First, the technical terms involved in the embodiments of the present application are introduced.

[0053] (1) Underdrive

[0054] Underactuation means that the number of independent control variables of the system is less than the degree of freedom of the system.

[0055] (2) Underactuated underwater vehicles

[0056] Those skilled in the art usually refer to an underwater vehicle in which the number of control input degrees of freedom is less than a preset value as an underactuated underwater vehicle.

[0057] For example, the preset value may be 6.

[0058] (3) Double ring

[0059] In this application, the complex interferences to the underwater vehicle are divided into outer loop kinematic interference and inner loop dynamic interference. The dual loops refer to the kinematic guidance law loop and the dynamic pitch tracking control law loop that control the underwater vehicle to perform the deep tracking task.

[0060] Next, the technical solutions provided in the embodiments of the present application are introduced.

[0061] The present application belongs to the field of underwater vehicle control, and relates to a dual-loop LQR robust depth tracking control method and system for an underactuated underwater vehicle. The method first provides a dual-loop control architecture for the depth control of the underwater vehicle, divides the complex interference to the vehicle into outer-loop kinematic interference and inner-loop dynamic interference, and provides an architecture support for the subsequent depth stability control; then, an adaptive line-of-sight angle guidance law is designed in the outer loop to overcome the underactuated characteristics, convert the depth tracking error into the desired pitch, and compensate for the kinematic interference caused by the unknown angle of attack; secondly, a simplified LQR method is designed in the inner loop based on the linear model of pitch motion to track the desired pitch, and an extended state observer is introduced to estimate the dynamic interference such as model nonlinearity, uncertainty, and external environment and compensate for it in the control law; finally, the above control algorithm is deployed on the onboard controller, and the elevator angle of the underwater vehicle is controlled by reading the real-time depth and attitude information fed back by the onboard sensor, so as to realize the dual-loop control architecture and ensure that the underwater vehicle performs the depth tracking task.

[0062] Figure 1 Flow chart of the dual-loop LQR robust depth tracking control method for an underactuated underwater vehicle provided in an embodiment of the present application; Figure 1 As shown, the following steps are included:

[0063] S101, obtaining a control target and state parameters of the underwater vehicle; the control target includes: a desired depth; the state parameters include: a real-time depth, a real-time speed, a real-time pitch angle, and a real-time pitch angle speed;

[0064] S102, determining a depth error between the desired depth and the real-time depth, and then designing an adaptive sight angle guidance law based on the depth error and the real-time speed to obtain a desired pitch angle of the underwater vehicle;

[0065] S103, designing a linear quadratic regulator LQR pitch tracking control law based on the observed dynamic disturbance of the underwater vehicle and the desired pitch angle to obtain a rudder angle of the underwater vehicle;

[0066] S104, controlling the elevator of the underwater vehicle based on the rudder angle, so that the underwater vehicle navigates at the desired depth.

[0067] In a specific embodiment, the present application provides a dual-loop LQR robust depth tracking control method for an underactuated underwater vehicle, which divides the complex disturbances to the underwater vehicle into a kinematic loop and a dynamic loop, and designs control laws in the dual loops to resist external complex interference. The outer kinematic loop mainly overcomes the underactuated characteristics of the hull through the designed adaptive line of sight angle guidance law, and compensates for the kinematic disturbance caused by the unknown angle of attack; the inner dynamic loop first uses an extended state observer to estimate the external disturbance, and then controls the elevator mechanism of the vehicle through the designed LQR controller to resist external environmental interference. The design of the above-mentioned two-layer control architecture solves the problem of insufficient depth control accuracy in complex environments when using conventional single-loop control.

[0068] In addition, the stability of the inner loop is the basis of the stability of the outer loop. When the stability of the inner loop is guaranteed, the stability of the outer loop ensures the stability of the overall system. Specifically, the kinematic outer loop inputs the calculated expected pitch angle into the dynamic inner loop as the tracking target of the inner loop according to the real-time depth error of the underwater vehicle, and the dynamic inner loop subtracts the obtained expected pitch angle from the real-time attitude of the hull, controls the elevator rudder angle through the obtained error, and then adjusts its own attitude to track the expected pitch angle of the outer loop kinematics, and indirectly controls the depth by controlling the pitch angle. In addition, the inner and outer loops respectively compensate and estimate the kinematic disturbance caused by the unknown angle of attack and the complex dynamic disturbance caused by the external environment, thereby realizing the robust depth tracking control of the underwater vehicle.

[0069] Finally, the dual-loop depth control architecture of the underactuated underwater vehicle is realized through the described method. The two loops are tightly coupled, and the control architecture is simple, which is convenient for engineering practice and application. The anti-interference ability and tracking accuracy of the underwater vehicle are improved, ensuring the robust control effect of the underwater vehicle in performing deep tracking tasks.

[0070] like Figure 2 As shown, it is a specific control flow chart of a dual-loop LQR robust depth tracking control method for an underactuated underwater vehicle designed in this application. This method is intended to improve the control accuracy of the underwater robot and enhance its anti-disturbance capability; its specific implementation process is as follows:

[0071] Step 1: First, determine the control target of the underwater vehicle and the required hull state information; the control target and the required hull state information include: the expected depth z d , real-time depth z, real-time speed U, real-time pitch angle θ and real-time pitch angular velocity q.

[0072] Then, the expected depth is smoothed by the tracking differentiator and then subtracted from the real-time depth to obtain the depth error z e, the adaptive line-of-sight angle guidance law designed by the outer loop is used to overcome the underactuated characteristics and compensate for the kinematic disturbance caused by the unknown angle of attack, and the desired pitch angle θ is calculated d The specific formula is Where Δ is the forward sight distance selected by the control engineer, which is generally 3-5 times the length of the boat. The real-time angle of attack is calculated using the adaptive angle of attack estimation law.

[0073] Furthermore, a simplified LQR method is designed in the inner loop based on the linear model of pitch motion to track the desired pitch angle. At the same time, an extended state observer is introduced to estimate the dynamic disturbances such as model nonlinearity, uncertainty, and external environment and compensate them into the control law.

[0074] In one example, an adaptive line-of-sight angle guidance law is designed in the outer kinematic loop to provide a desired pitch for an underwater vehicle. The designed adaptive angle of attack estimation law is shown below:

[0075]

[0076] Where γ is the adaptive parameter selected by the control engineer. The real-time estimated angle of attack is obtained by integrating the above formula in real time, and the initial value is zero.

[0077] Step 2: Compensate the calculated real-time angle of attack into the line-of-sight angle guidance law. The specific formula is:

[0078]

[0079] The desired pitch angle is obtained by the upper underwater vehicle.

[0080] Step 3: Design an LQR controller in the inner dynamic loop, and combine the LQR pitch tracking control law and the extended state observer to calculate the final elevator rudder angle, which is shown in the following formula:

[0081] u0=-Kx-B -1 F

[0082] Where x = [q θ e ] T ,θ e is the difference between the desired pitch angle and the actual pitch angle, B = [b0 0] T is the control matrix of the system, b0 represents the rudder efficiency coefficient of the underwater vehicle, is the compensation matrix, represents the disturbance calculated by the extended state observer. K=[k1 k2] T is the feedback gain matrix, and its value is obtained by solving the following Riccati equation:

[0083] A TP+PA-PBR -1 B T P+Q=0

[0084] K=R -1 B T P

[0085] in, B is the control matrix of the system, Q and R are the weight coefficient matrices selected by the control engineer, and P is a symmetric semi-positive definite matrix, which is the solution to the Riccati equation.

[0086] Step 4: Estimate the external complex disturbances to the underwater vehicle based on the designed extended state observer, specifically:

[0087]

[0088] in represents the observer gain matrix, is the state estimation matrix, and the internal state quantities represent the estimation of the pitch angle, pitch angular velocity and disturbance. B0=[0 b0 0] T , δ s represents the elevator rudder angle, Y = [θ q] T .

[0089] The state is estimated by real-time integration of the above equation, which ensures accurate estimation of external complex disturbances and is fed back to the inner-loop LQR controller to achieve robust compensation for external environmental disturbances.

[0090] Step 5: Finally, the above control method is programmed using C language, and the information returned by the navigation information determination unit is parsed according to the communication protocol, including the depth, attitude and other navigation information of the underwater vehicle; then the navigation information obtained by the sensor is calculated according to the onboard controller unit to obtain the control output instruction; finally, the control signal is converted into signals such as the rudder angle, and the calculated rudder angle instruction is used to achieve precise depth control of the underwater vehicle under external environmental interference.

[0091] Implementation Cases:

[0092] In order to verify the depth tracking control effect of the method in this application, the underwater vehicle developed by the laboratory was used for testing. The test scenario of the vehicle is as follows: Figure 3As shown. The underwater vehicle is an underactuated configuration, controlled only by the tail thruster and the cross rudder. The vehicle is equipped with a depth gauge and an attitude sensor, which can feedback real-time depth and attitude, and has the ability to verify the dual-loop LQR robust depth tracking control method. By writing C language code in the onboard computer of the underwater vehicle, the ability to collect the depth and attitude feedback from the sensor in real time and control the elevator angle is realized, and the code realizes the dual-loop LQR robust depth tracking control method of the underactuated underwater vehicle.

[0093] The test results are as follows Figure 4-Figure 7 As shown, first the expected depth gradually changes from 0m to 2m, and then is maintained for 60 seconds. The onboard computer of the underwater vehicle calculates the real-time rudder angle according to the control law to achieve diving. After reaching the depth of 2m, it maintains deep navigation and autonomously surfaces after reaching 60s, completing the entire test process.

[0094] Figure 4 The depth change curve of the spacecraft is shown in Figure 4 It can be seen that, thanks to the adaptive line of sight angle guidance law designed in the kinematic outer loop, the actual depth of the underwater vehicle can maintain the expected depth within an error of 0.03m after reaching the expected depth of 2m, and the underwater vehicle achieves high-precision depth control.

[0095] Figure 5 The time curve of the vehicle's pitch change is given. It can be seen that the actual pitch of the underwater vehicle is highly consistent with the expected pitch curve. This is due to the LQR controller and extended state observer designed in the inner loop of the dynamics, which overcomes the complex external interference and ensures the stable navigation of the underwater vehicle.

[0096] In addition Figure 5 and Figure 6 It can be seen that the observed pitch of the aircraft gradually converges to the actual pitch, and the observed pitch angular velocity also gradually converges to the actual pitch angular velocity. Therefore, according to the stability of the expanded observer, it can be inferred that the observed complex external disturbance also converges to the real disturbance, so that the estimated value of the disturbance is fed back to the controller, so that the aircraft can achieve excellent tracking of the desired pitch angle.

[0097] Finally, in order to ensure the safety of underwater vehicles, their buoyancy is usually slightly greater than gravity, so after the vehicle is in a steady state, there is usually a small angle of attack. When the vehicle is stable at a depth underwater, its pitch angle is equal to the angle of attack. Figure 5 From 40 seconds to 50 seconds, it can be seen that the angle of attack of the aircraft is about 0.8°, while the angle of attack estimated by the designed adaptive angle of attack estimation law is about Figure 7It is also located near 0.8°, which indirectly verifies that the designed adaptive line of sight angle guidance law can effectively estimate the unknown angle of attack of the spacecraft, thereby verifying its effect of eliminating the kinematic disturbance of the outer loop.

[0098] Figure 8 The architecture diagram of the dual-loop LQR robust depth tracking control system for an underactuated underwater vehicle provided in an embodiment of the present application; Figure 8 As shown, including:

[0099] The parameter acquisition unit 810 is used to acquire the control target and state parameters of the underwater vehicle; the control target includes: expected depth; the state parameters include: real-time depth, real-time speed, real-time pitch angle and real-time pitch angle speed;

[0100] An outer loop control unit 820, configured to determine a depth error between the desired depth and the real-time depth, and then design an adaptive sight angle guidance law based on the depth error and the real-time speed to obtain a desired pitch angle of the underwater vehicle;

[0101] An inner loop control unit 830 is used to design an LQR pitch tracking control law in combination with the observed dynamic disturbance of the underwater vehicle and the desired pitch angle to obtain a rudder angle of the underwater vehicle;

[0102] The vehicle control unit 840 is used to control the elevator of the underwater vehicle based on the rudder angle, so that the underwater vehicle navigates at the desired depth.

[0103] Optionally, the inner loop control unit 830 determines a state matrix according to the real-time pitch angular velocity and the real-time pitch angle error; the real-time pitch angle error is determined based on the difference between the expected pitch angle and the real-time pitch angle; and calculates the rudder angle of the underwater vehicle at the current moment based on the state matrix, a control matrix related to the rudder efficiency coefficient of the underwater vehicle, a supplementary matrix related to the expected pitch angle and dynamic disturbance, and a feedback gain matrix.

[0104] It should be understood that the above-mentioned system is used to execute the methods in the above-mentioned embodiments. The implementation principles and technical effects of the corresponding program units in the system are similar to those described in the above-mentioned methods. The working process of the system can refer to the corresponding process in the above-mentioned method and will not be repeated here.

[0105] Based on the method in the above embodiment, the present application embodiment provides an electronic device, see Fig. 9As shown, the electronic device may include: a processor 910, a communication interface 920, a memory 930 and a communication bus 940, wherein the processor 910, the communication interface 920 and the memory 930 communicate with each other via the communication bus 940. The processor 910 may call the logic instructions in the memory 930 to execute the method in the above embodiment.

[0106] In addition, the logic instructions in the above-mentioned memory can be implemented in the form of software functional units and can be stored in a computer-readable storage medium when sold or used as an independent product. Based on this understanding, the technical solution of the present application, or the part that contributes to the prior art, or the part of the technical solution, can be embodied in the form of a software product, which is stored in a storage medium and includes a number of instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present application.

[0107] Based on the method in the above embodiment, an embodiment of the present application provides a computer-readable storage medium, which stores a computer program. When the computer program runs on a processor, the processor executes the method in the above embodiment.

[0108] Based on the method in the above embodiment, an embodiment of the present application provides a computer program product. When the computer program product runs on a processor, the processor executes the method in the above embodiment.

[0109] It is understandable that the processor in the embodiment of the present application can be a central processing unit (CPU), or other general-purpose processors, digital signal processors (DSP), application specific integrated circuits (ASIC), field programmable gate arrays (FPGA) or other programmable logic devices, transistor logic devices, hardware components or any combination thereof. The general-purpose processor can be a microprocessor or any conventional processor.

[0110] The method steps in the embodiments of the present application can be implemented by hardware or by a processor executing software instructions. The software instructions can be composed of corresponding software modules, and the software modules can be stored in random access memory (RAM), flash memory, read-only memory (ROM), programmable read-only memory (PROM), erasable programmable read-only memory (EPROM), electrically erasable programmable read-only memory (EEPROM), registers, hard disks, mobile hard disks, CD-ROMs, or any other form of storage medium known in the art. An exemplary storage medium is coupled to a processor so that the processor can read information from the storage medium and write information to the storage medium. Of course, the storage medium can also be a component of the processor. The processor and the storage medium can be located in an ASIC.

[0111] In the above embodiments, it can be implemented in whole or in part by software, hardware, firmware or any combination thereof. When implemented using software, it can be implemented in whole or in part in the form of a computer program product. The computer program product includes one or more computer instructions. When the computer program instructions are loaded and executed on a computer, the process or function described in the embodiment of the present application is generated in whole or in part. The computer may be a general-purpose computer, a special-purpose computer, a computer network, or other programmable device. The computer instructions may be stored in a computer-readable storage medium or transmitted through the computer-readable storage medium. The computer instructions may be transmitted from a website site, a computer, a server or a data center by wired (e.g., coaxial cable, optical fiber, digital subscriber line or wireless (e.g., infrared, wireless, microwave, etc.) mode to another website site, computer, server or data center. The computer-readable storage medium may be any available medium that a computer can access or a data storage device such as a server or a data center that includes one or more available media integrated. The available medium may be a magnetic medium (e.g., a floppy disk, a hard disk, a tape), an optical medium (e.g., a DVD), or a semiconductor medium (e.g., a solid state disk (SSD)), etc.

[0112] It should be understood that the various numerical numbers involved in the embodiments of the present application are only used for the convenience of description and are not used to limit the scope of the embodiments of the present application.

[0113] It will be easily understood by those skilled in the art that the above description is only a preferred embodiment of the present application and is not intended to limit the present application. Any modifications, equivalent substitutions and improvements made within the spirit and principles of the present application shall be included in the scope of protection of the present application.

Claims

1. A dual-loop LQR robust depth tracking control method for an underactuated underwater vehicle, characterized in that: include: Obtaining the control target and state parameters of the underwater vehicle; The control target includes: expected depth; the state parameters include: real-time depth, real-time speed, real-time pitch angle and real-time pitch angle speed; Determine the depth error between the desired depth and the real-time depth, and then design an adaptive sight angle guidance law based on the depth error and the real-time speed to obtain the desired pitch angle of the underwater vehicle; the adaptive sight angle guidance law includes the following formula: in, is the depth error, is the foresight distance, is the desired pitch angle, is the estimated real-time angle of attack, is the first-order differential of the estimated real-time angle of attack, is an adaptive parameter; a linear quadratic regulator LQR pitch tracking control law is designed in combination with the observed dynamic disturbance of the underwater vehicle and the desired pitch angle to obtain the rudder angle of the underwater vehicle; the LQR pitch tracking control law includes the following formula: in, Indicates the calculation of the current rudder angle. x represents the state matrix, , is the real-time pitch angular velocity, The expected pitch angle With real-time trim angle The pitch angle error between is the control matrix, represents the rudder efficiency coefficient of the underwater vehicle, is the compensation matrix, is the first-order differential of the desired pitch angle, represents the dynamical perturbation, is the feedback gain matrix; The elevator of the underwater vehicle is controlled based on the rudder angle so that the underwater vehicle navigates at the desired depth.

2. The method according to claim 1, characterized in that The LQR pitch tracking control law is designed by combining the observed dynamic disturbance of the underwater vehicle and the desired pitch angle, specifically: Determine a state matrix according to the real-time pitch angular velocity and the real-time pitch angle error; the real-time pitch angle error is determined based on the difference between the expected pitch angle and the real-time pitch angle; The rudder angle of the underwater vehicle at the current moment is calculated based on the state matrix, the control matrix related to the underwater vehicle rudder efficiency coefficient, the supplementary matrix related to the expected pitch angle and dynamic disturbance, and the feedback gain matrix.

3. The method according to claim 1, characterized in that The dynamic perturbation Calculated by the following formula: in, represents the gain matrix of the observer used to obtain the pitch angle observation value and the pitch angular velocity observation value, is the state estimation matrix, represents the observed value of the pitch angle, represents the observed value of the pitch angular velocity, , , , represents the calculated rudder angle at the last moment, .

4. The method according to claim 1, characterized in that: The feedback gain matrix Calculated by the following formula: in, , Q and R is the preset weight coefficient matrix, P is a positive semidefinite matrix.

5. A dual-loop LQR robust depth tracking control system for an underactuated underwater vehicle, characterized in that: include: A parameter acquisition unit, used to acquire control targets and state parameters of the underwater vehicle; The control target includes: expected depth; the state parameters include: real-time depth, real-time speed, real-time pitch angle and real-time pitch angle speed; The outer loop control unit is used to determine the depth error between the desired depth and the real-time depth, and then design an adaptive line-of-sight angle guidance law based on the depth error and the real-time speed to obtain the desired pitch angle of the underwater vehicle; the adaptive line-of-sight angle guidance law includes the following formula: in, is the depth error, is the foresight distance, is the desired pitch angle, is the estimated real-time angle of attack, is the first-order differential of the estimated real-time angle of attack, is the adaptive parameter; The inner loop control unit is used to design a linear quadratic regulator LQR pitch tracking control law in combination with the observed dynamic disturbance of the underwater vehicle and the desired pitch angle to obtain the rudder angle of the underwater vehicle; the LQR pitch tracking control law includes the following formula: in, Indicates the calculation of the current rudder angle. x represents the state matrix, , is the real-time pitch angular velocity, The expected pitch angle With real-time trim angle The pitch angle error between is the control matrix, represents the rudder efficiency coefficient of the underwater vehicle, is the compensation matrix, is the first-order differential of the desired pitch angle, represents the dynamical perturbation, is the feedback gain matrix; The vehicle control unit is used to control the elevator of the underwater vehicle based on the rudder angle so that the underwater vehicle navigates at the desired depth.

6. The system according to claim 5, characterized in that The inner loop control unit determines a state matrix according to the real-time pitch angular velocity and the real-time pitch angle error; the real-time pitch angle error is determined based on the difference between the expected pitch angle and the real-time pitch angle; and calculates the rudder angle of the underwater vehicle at the current moment based on the state matrix, a control matrix related to the rudder efficiency coefficient of the underwater vehicle, a supplementary matrix related to the expected pitch angle and dynamic disturbance, and a feedback gain matrix.

7. An electronic device, characterized in that: include: at least one memory for storing a computer program; At least one processor is used to execute the program stored in the memory. When the program stored in the memory is executed, the processor is used to execute the method according to any one of claims 1 to 4.

8. A computer-readable storage medium storing a computer program, characterized in that: When the computer program runs on a processor, the processor is caused to execute the method according to any one of claims 1 to 4.