An Adaptive Disturbance Dynamics Control Method for Operational Underwater Robots
By using adaptive control and a nonlinear disturbance observer to estimate the coupling and external disturbances of the underwater robot system, the problem of control instability during the movement of the underwater robot arm was solved, achieving stable dynamic control and improving operational capabilities.
Patent Information
- Application Number
- CN202410675616.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-05-29
- Publication Date
- 2026-11-17
- Estimated Expiration
- 2044-05-29
AI Technical Summary
During the movement of the underwater robot's robotic arm, there is a coupling dynamic influence between the carrier and the robotic arm. Uncertainty in the dynamic model and external disturbances lead to unstable control, making it difficult to complete stable underwater operations.
An adaptive control method is used to estimate the coupling force in the system, and a nonlinear disturbance observer is used to estimate the uncertainty of the dynamic model and the external ocean current disturbance. The adaptive control law is used to update the parameter variables and compensate for the reaction torque of the robotic arm on the carrier in real time to achieve stable control.
This improves the operational capabilities of underwater robots, enabling them to achieve stable dynamic control in real-world environments, adapt to external disturbances, and enhance the reliability of robot attitude control.
Smart Images

Figure CN118404584B_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of dynamic control technology for underwater robots, and in particular to a carrier dynamic control method for operational robots during the movement of their robotic arms. Background Technology
[0002] Underwater robots are widely used in tasks such as underwater structure inspection, underwater rescue and salvage, underwater mineral resource development, and oil drilling platforms. These tasks require underwater robots to be equipped with robotic arms to interact with the environment and perform underwater operations with a certain load. However, during the movement of the robotic arm, a reaction force is generated on the robotic arm base. This is known as the coupling between the carrier and the robotic arm in the underwater robot system, which often adversely affects the dynamic control of the carrier. In addition, uncertainties in the dynamic model of the underwater robot and external disturbances such as ocean currents can also adversely affect the control of the carrier, making it difficult to complete stable underwater operations.
[0003] The dynamic coupling of an underwater robotic arm's motion includes both static and dynamic components. For most robotic systems, the arm lacks buoyancy and operates at a very slow speed; therefore, statics constitute the majority of the coupling force. Currently, this coupling can be measured using torque sensors, but these sensors are expensive and limited by operating depth, hindering practical application. Existing control methods involve designing disturbance observers to estimate the uncertainties in system dynamics and external disturbances. However, the robotic arm's motion causes rapid changes in the system's center of gravity and center of buoyancy, making it difficult for disturbance observers to accurately and quickly estimate the actual disturbances. Summary of the Invention
[0004] This invention addresses the problems in the background art by designing an adaptive method to specifically estimate the coupling forces existing in the system and achieving stable control of the carrier through compensation, thereby ensuring the reliability of robot operations. This invention also provides an adaptive disturbance dynamics control method for underwater robots. It utilizes adaptive control to estimate the couplings existing in the system and uses a nonlinear disturbance observer to estimate the uncertainties in the system's dynamic model and external ocean current disturbances, which can improve the carrier control performance of underwater robots and enhance their underwater operational capabilities.
[0005] The technical solution adopted by the present invention to achieve the above objectives is as follows:
[0006] An adaptive disturbance dynamics control method for operational underwater robots includes the following steps:
[0007] 1) Based on the motion data of underwater robots, construct a dynamic model of underwater operation robots;
[0008] 2) Initialize the parameter variables in the dynamic model;
[0009] 3) Update parameter variables using adaptive control law;
[0010] 4) Update external disturbances using a nonlinear disturbance observer;
[0011] 5) Calculate the control torque of the underwater robot and send it to the real robot to complete one cycle of robot control;
[0012] 6) Repeat steps 3) to 5) to estimate and compensate for the motion process of the underwater robot in real time, thus completing the dynamic control of the underwater robot.
[0013] The dynamic model of the operational robot is as follows:
[0014]
[0015] Among them, process variables g v (ν)=g d (ν)=M -1 ν represents the velocity and position variables of the underwater robot carrier system, and M represents... v For the mass matrix of an underwater robot, C v For the Coriolis force matrix of an underwater robot, D v For the damping force matrix of the underwater robot, Φ g For the gravity-buoyancy vector linear operator of underwater robots, Θ g τ represents the gravity and buoyancy parameters of an underwater robot. v The input torque τ for an underwater robot. d This refers to the external disturbance torque of an underwater robot.
[0016] Step 2) specifically refers to:
[0017] Initialize the gravity and buoyancy parameters Θ of the underwater robot g And the internal variable h of the perturbation observer, i.e.:
[0018] If there is prior knowledge about the system's gravity and buoyancy parameters, the parameters are initialized according to the prior knowledge; otherwise, both parameters are initialized to zero vectors.
[0019] Step 3) specifically refers to:
[0020] Gravity and buoyancy parameters Θ of underwater robots g To update, that is:
[0021]
[0022]
[0023] in, For speed error, For system position error, For the system's attitude error, K is the rotation transformation matrix from the world coordinate system to the vehicle coordinate system. Λ Let be the coefficient matrix, s be the generalized position error of the system, and K be the coefficient matrix. Θ This is the update matrix for the adaptive control law. For Θ g The derivative with respect to time, based on the set initial values, is: The gravity and buoyancy parameters Θ can be obtained by integrating over time. g .
[0024] Step 4) specifically involves:
[0025] Calculate the derivative of the internal variables And based on the initialization parameters Integrating to obtain h, and using h and w to calculate the system disturbance τ in real time. d ,Right now:
[0026] w=K w ν
[0027]
[0028]
[0029] τ d =h+w
[0030] Where w and h are internal variables of the perturbation observer, and K w and K d ν is the internal gain of the perturbation observer, and l(ν) is the partial derivative of w with respect to ν.
[0031] Step 5) specifically involves:
[0032]
[0033] Where, ν a For the desired velocity of kinematic programming, K s τ is the proportional gain of the controller. v This refers to the control torque of the underwater robot.
[0034] The present invention has the following beneficial effects and advantages:
[0035] 1. Compared with traditional underwater robot control, the control method described above can be applied to the dynamic control of the robotic arm during its movement, thereby improving the operational capabilities of the underwater robot.
[0036] 2. This invention can estimate model uncertainties and ocean current disturbances, achieve stable dynamic control in actual underwater environments, and has the ability to adapt to external disturbances.
[0037] 3. This invention utilizes adaptive control to identify the system's center of gravity and center of buoyancy parameters in real time, and compensates for the reaction torque generated by the robotic arm on the carrier in real time, resulting in better attitude control of the underwater robot. Attached Figure Description
[0038] Figure 1 Structural diagram of the underwater operation robot involved in this invention;
[0039] Figure 2 A flowchart of the underwater flying robotic arm control method of the present invention. Detailed Implementation
[0040] The present invention will now be described in further detail with reference to the accompanying drawings and embodiments.
[0041] This invention utilizes adaptive control and a nonlinear disturbance observer to estimate unmodeled dynamics, system coupling, and external ocean current disturbances, thereby achieving stable carrier control and ensuring the reliability of robot operations.
[0042] The entire system consists of an underwater robotic platform, two robotic arms, and a navigation system. The navigation system is equipped with necessary navigation sensors, including an inertial measurement unit (IMU), an electronic compass, a Doppler velocimeter, and a depth gauge. The IMU measures the three-axis acceleration of the robotic platform; the electronic compass measures the heading, pitch, and roll angles; the Doppler velocimeter measures the translational velocity; the depth gauge measures the depth; and the robotic arms are used to perform underwater operations.
[0043] underwater operation robot structure such as Figure 1 As shown.
[0044] like Figure 2 As shown, the entire system operates according to the following process:
[0045] The dynamic model of an underwater robot can be expressed as follows:
[0046]
[0047] ν=[uvwpqr] TThe velocity variables of the underwater robot carrier system are represented by u, v, w, p, q, and r, which represent the forward velocity, rightward velocity, vertical velocity, roll angular velocity, pitch angular velocity, and bow angular velocity of the underwater robot, respectively. v The mass matrix representing underwater robots, C v The Coriolis force matrix representing underwater robots, D v The damping force matrix representing an underwater robot, Φ g The linear operator representing the gravity-buoyancy vector of an underwater robot, Θ g τ represents the gravity and buoyancy parameter of an underwater robot. v τ represents the input torque of an underwater robot. d This represents the external disturbance torque of an underwater robot. Underwater robot models typically utilize g... RB This represents the vector of gravity and buoyancy, and the relationship between this vector and the linear operators and parameters of the gravity and buoyancy vectors is as follows:
[0048] g RB =Φ g Θ g (2)
[0049] The dynamic model of an underwater robot can be expressed in a more general form.
[0050]
[0051] in, g v (ν)=g d (ν)=M -1 .
[0052] The first step is to initialize the parameter variable Θ. g If there is prior knowledge about the system's gravity and buoyancy parameters, then these parameters can be initialized accordingly; otherwise, both parameters are initialized to zero vectors.
[0053] The second step is to update Θ using the adaptive control law. g .
[0054] The generalized position error s of the system can be defined as
[0055]
[0056] in For speed error, For system position error, For the system's attitude error, K is the rotation transformation matrix from the world coordinate system to the vehicle coordinate system. ΛLet be the coefficient matrix. The generalized position error of this system is defined by a sliding surface, and in steady state and at s=0, the system will have no position deviation.
[0057] The update formula for the system's gravity and buoyancy parameters is as follows:
[0058]
[0059] Among them, K Θ This is the update matrix for the adaptive control law. For Θ g The derivative with respect to time, based on the initial value set in the first step, is: The gravity and buoyancy parameters Θ can be obtained by integrating over time. g .
[0060] The third step is to update the external disturbance τ using a nonlinear disturbance observer. d .
[0061]
[0062] Where w and h are internal variables of the perturbation observer, and K w and K d ν is the internal gain of the perturbation observer, and l(ν) is the partial derivative of w with respect to ν. It can be calculated using the above formula. And based on the initialization parameters Integrating h yields a value, and using h and w, the system disturbance τ is calculated in real time. d .
[0063] The fourth step is to calculate the control torque of the system and input it into the real robot.
[0064]
[0065] Where, ν a For the desired velocity of kinematic programming, K s This is the proportional gain of the controller.
[0066] The above describes the content of the first control cycle of the underwater operation robot. After the first control cycle, it is only necessary to repeat the second to fourth steps to estimate and compensate for the effects of model uncertainty, dynamic coupling and external ocean current disturbance in real time, so as to achieve stable dynamic control.
Claims
1. An adaptive disturbance dynamics control method suitable for operational underwater robots, characterized in that, Includes the following steps: 1) Based on the motion data of underwater robots, construct a dynamic model of underwater operation robots; 2) Initialize the parameter variables in the dynamic model; 3) Update parameter variables using adaptive control law; 4) Update external disturbances using a nonlinear disturbance observer; 5) Calculate the control torque of the underwater robot and send it to the real robot to complete one cycle of robot control; 6) Repeat steps 3) to 5) to estimate and compensate for the motion of the underwater robot in real time, and complete the dynamic control of the underwater robot; The dynamic model of the operational robot is as follows: ; Among them, process variables , , For the velocity and position variables of the underwater robot carrier system, The mass matrix of an underwater robot. For the Coriolis force matrix of underwater robots, The damping force matrix for underwater robots. For the gravity-buoyancy vector linear operator of underwater operation robots, These are the gravity and buoyancy parameters for underwater robots. For the input torque of the underwater robot, External disturbance torque for underwater operation robots; Step 3) specifically refers to: Gravity and buoyancy parameters of underwater robots To update, that is: ; ; in, For speed error, For system position error, For the system's attitude error, Let be the rotation transformation matrix from the world coordinate system to the vehicle coordinate system. The coefficient matrix, For the system's generalized position error, This is the update matrix for the adaptive control law. for The derivative with respect to time, based on the set initial values, is: The gravity and buoyancy parameters can be obtained by integrating over time. .
2. The adaptive disturbance dynamics control method for operational underwater robots according to claim 1, characterized in that, Step 2) specifically refers to: Initialize the gravity and buoyancy parameters of the underwater robot and the internal variables of the perturbation observer. ,Right now: If there is prior knowledge about the system's gravity and buoyancy parameters, the parameters are initialized according to the prior knowledge; otherwise, both parameters are initialized to zero vectors.
3. The adaptive disturbance dynamics control method for operational underwater robots according to claim 1, characterized in that, Step 4) specifically involves: Calculate the derivative of the internal variables And based on the initialized parameters Earn points ,use and Disturbances in real-time computing systems ,Right now: ; in, and These are internal variables of the perturbation observer. and It is the internal gain of the perturbation observer. yes right The partial derivatives of .
4. The adaptive disturbance dynamics control method for operational underwater robots according to claim 1, characterized in that, Step 5) specifically involves: ; in, The desired velocity for kinematic planning, For the proportional gain of the controller, This refers to the control torque of the underwater robot.
Citation Information
Patent Citations
Sliding mode control method for underwater robot based on expansion state observer
CN108241292A
