METHOD AND SYSTEM FOR TRAJECTORY TRACKING CONTROL OF VEHICLE-MANIPULATOR COUPLING SYSTEM WITH FINITE TIME PRESCRIBED PERFORMANCE

20250238039 ยท 2025-07-24

Assignee

Inventors

Cpc classification

International classification

Abstract

The disclosure provides a method and system for trajectory tracking control of a vehicle-manipulator coupling system with finite time prescribed performance. Specifically, a coupling weaken trajectory planning method is designed to reduce the system's coupling effects. A finite time performance function is designed to constrain the trajectory tracking error. In a case the constraint conditions corresponding to the finite time performance function are satisfied, the trajectory tracking error is converted to obtain a transformed error. The sliding mode surface is designed based on the transformed error to control the transformed error to converge in a finite time, and the external disturbance of the vehicle-manipulator coupling system is observed based on non-linear disturbance observer. The control input of the vehicle-manipulator coupling system is designed based on the sliding mode surface and the non-linear disturbance observer output. This ensures that the vehicle-manipulator coupling system can operate precisely along the desired trajectory.

Claims

1. A method for trajectory tracking control of a vehicle-manipulator coupling system with finite time prescribed performance, the method is applied to the vehicle-manipulator coupling system to control a motion trajectory of the vehicle-manipulator coupling system, the vehicle-manipulator coupling system comprises an underwater vehicle and a robotic arm, and the method comprises following steps: obtaining a present motion state, and a desired trajectory with a weakly coupling characteristic of the vehicle-manipulator coupling system is obtained by a coupling weaken trajectory planning method, so as to calculate a difference between the present motion state and the desired trajectory to obtain a trajectory tracking error; designing a finite time performance function to constrain the trajectory tracking error so that the vehicle-manipulator coupling system reaches a steady state in response to the trajectory tracking error converging to a preset convergence boundary; and a gradient of the finite time performance function is not zero in response to an operation time of the vehicle-manipulator coupling system exceeding a preset convergence time, so as to avoid generating a singularity in a calculation of the state of the vehicle-manipulator coupling system and to ensure that a controller of the vehicle-manipulator coupling system does not diverge; converting the trajectory tracking error to obtain a corresponding transformed error in a case that constraint conditions corresponding to the finite time performance function are satisfied; designing a sliding mode surface of the vehicle-manipulator coupling system based on the transformed error to control the transformed error to converge in a finite time, and observing an external disturbance of the vehicle-manipulator coupling system based on a non-linear disturbance observer and the sliding mode surface; designing a control input of the vehicle-manipulator coupling system based on the sliding mode surface and an external disturbance observer, so that the vehicle-manipulator coupling system is controlled to operate according to the desired trajectory; wherein designing the control input of the vehicle-manipulator coupling system based on the sliding mode surface and the external disturbance observer specifically is: m = A m - 1 [ - B m - F d m - - 1 ( H m + k .Math. s m .Math. 1 2 sign ( S m ) + 0 t k sign ( s m ( ) ) d ) ] , wherein .sub.m represents a control input, k.sub.a and k.sub. represent controller parameters to be designed, sign(.Math.) represents a signum function, 0 represents the time, s.sub.m() represents a value of s.sub.m at the time , s.sub.m represents the sliding mode surface, .sub.0.sup.tk.sub.sign(s.sub.m())d represents an integral of k.sub.sign(s.sub.m) at a time interval [0, t]; A.sub.m and B.sub.m represent a matrix related to a dynamics model of the vehicle-manipulator coupling system; {circumflex over (F)}.sub.dm represents observation of a unknown external disturbance; = ( u + l ) m 2 ( l m + e ) ( u m - e ) , .sub.l and .sub.u represent performance boundary coefficients, .sub.e represents the trajectory tracking error, .sub.m is an abbreviation of .sub.m(t), and .sub.m(t) represents a trajectory tracking error boundary; and H m = ( m + ) ( e - e . m m ) - .Math. . e . m m + e .Math. m m - e . m 2 m 2 - .Math. d , {dot over ()} represents a first order derivative of , {umlaut over ()}.sub.m is an abbreviation of {umlaut over ()}.sub.m(t) being a second order derivative of .sub.m(t), {umlaut over (n)}.sub.d represents a second order derivative of the desired trajectory .sub.d, {dot over ()}.sub.e represents a first order derivative of the trajectory tracking error .sub.e, .sub.m represents a diagonal sliding mode surface coefficient matrix, and {dot over ()}.sub.m is an abbreviation of {dot over ()}.sub.m(t) being the first order derivative of .sub.m(t), wherein the control input includes control signals of the underwater vehicle and control signals of the robotic arm, the controller of the vehicle-manipulator coupling system controls thrusters of the underwater vehicle to output corresponding control forces based on the control signals of the underwater vehicle, and controls joint motors of the robotic arm to output corresponding torques based on the control signals of the robotic arm, such that the robotic arm performs a grasping action after the underwater vehicle moves to a target position.

2. The method according to claim 1, wherein the improved finite time performance function is: m ( t ) = { ( 0 - t ) 1 / + c , 0 t < T m ( c - ) e - k ( t - T m ) + , t T m , wherein .sub.0 represents a preset initial error boundary, and .sub.0>0; .sub.c represents a trajectory tracking error preset convergence boundary, and 0<.sub.c<<.sub.0; .sub. represents a trajectory tracking error asymptotic convergence boundary, and 0<.sub.<.sub.c; , , k represent prescribed performance parameters, configured to adjust a convergence rate and a convergence time of the finite time performance function; e represents a natural constant; t represents a time process; and T.sub.m represents a preset convergence time, and T.sub.m=.sub.0.sup./().

3. The method according to claim 2, wherein .sub.e represent the trajectory tracking error, .sub.e=.sub.d, represents the present motion state, and n.sub.d represents the desired trajectory; the finite time performance function constraining the trajectory tracking error specifically is: - k l m ( t ) < e < k u m ( t ) .

4. The method according to claim 3, wherein error transformation is performed on the trajectory tracking error .sub.e in order to satisfy constraining the finite time performance function, the transformed error is represented by .sub.,: = 1 2 ln + k l k u - , wherein custom-character=.sub.e/.sub.m, and the first order derivative {dot over ()}.sub. of the transformed error .sub. is : . = ( e - . m m ) .

5. The method according to claim 4, wherein a motion model of the vehicle-manipulator coupling system is represented by: { x 1 = x 2 x 2 = A m m + B m + F dm , wherein x.sub.1 =, x.sub.2 represents a speed state vector, F.sub.dm represents the unknown external disturbance received by the vehicle-manipulator coupling system; designing the sliding mode surface S.sub.m based on the transformed error .sub.: S m = m + .

6. The method according to claim 5, wherein observing the external disturbance of the vehicle-manipulator coupling system based on the non-linear disturbance observer and the sliding mode surface specifically is: { F ^ d m = d m + K d m S m d m = - L d m d m - L d m ( K d m S m + - 1 H m + A m m + B m ) , wherein .sub.dm represents an auxiliary intermediate variable of the non-linear disturbance observer, L.sub.dm and K.sub.dm represent gain coefficients of the non-linear disturbance observer, and K.sub.dm satisfies K.sub.dm=L.sub.dm.sup.1.

7. The method according to claim 1, wherein the coupling weaken trajectory planning method uses a dynamic equation of the vehicle-manipulator coupling system, which is written as follows: M v v + C v ( v ) v + D v ( v ) v + G v ( v 2 ) - M mv , q ( q ) q .Math. - M mv , v ( q ) v - C mv ( q , q . , v ) - D mv ( q , q , v ) - G mv ( q , v 2 ) = 0 , wherein M.sub.v includes a rigid body inertia matrix and an added mass inertia matrix of the underwater vehicle, C.sub.v(v) includes a vehicle coriolis centripetal force matrix of rigid body and a coriolis centripetal force matrix of added mass, D.sub.v(v) denotes a damping matrix of the underwater vehicle, G.sub.v(.sub.v2) denotes a gravity and a buoyancy of the underwater vehicle, M.sub.mv,q(q) denotes a coupling inertial matrix induced by an acceleration of the robotic arm, C.sub.mv(q,{dot over (q)},v) denotes a coupling coriolis centripetal force and a moment acting on the underwater vehicle induced by the coupling velocity of the robotic arm and the underwater vehicle, D.sub.mv(q,{dot over (q)},v) denotes a coupling damping force and a moment acting on the vehicle induced by the coupling velocity of the robotic arm and the underwater vehicle, G.sub.mv(q,.sub.v2) denotes a coupling buoyancy and a gravity force and a moment of the robotic arm acting on the underwater vehicle, v denotes a velocity vector of the underwater vehicle, .sub.v2 denotes an attitude vector of the underwater vehicle, {dot over (v)} denotes an acceleration vector of the underwater vehicle, q denotes a joint angle vector of the robotic arm, {dot over (q)} denotes a joint angular velocity vector of the robotic arm, {umlaut over (q)} denotes a joint angular acceleration vector of the robotic arm, the above three parameters q, {dot over (q)}, {umlaut over (q)} are obtained by a motor encoder of each joint, the dynamic equation of the vehicle-manipulator coupling system is transformed into: [ M v - M mv , v ( q ) ] v . = [ ( C mv ( q , q . , v ) + D mv ( q , q . , v ) + G mv ( q , v 2 ) - C v ( v ) v - D v ( v ) v - G v ( v 2 ) ) q .Math. + M mv , q ( q ) ] q .Math. , wherein {umlaut over (q)}.sup. denotes a normalized inverse vector of the joint angular acceleration, {dot over (v)}=V.sub.coupling.sub.mv{umlaut over (q)}, V.sub.coupling.sub.mv=.sup.1V.sub.cm is designed as a coupling characteristic index, V c v = M v - M mv , v ( q ) V c m = [ C m v ( q , q . , v ) + D m v ( q , q . , v ) + G m v ( q , v 2 ) - C v ( v ) v - D v ( v ) v - G v ( v 2 ) ] q .Math. + M m v , q ( q ) .

8. The method according to claim 7, wherein the coupling characteristic index V.sub.coupling.sub.mv is processed by a singular value decomposition, and a coupling intensity of the vehicle-manipulator coupling system is quantitatively presented by S coupling ( v , v , v 2 , q , q , q .Math. ) = s 1 1 + s 2 2 + .Math. + s m m m , where .sub.i denotes an i.sup.th singular value of V.sub.coupling.sub.mv, s.sub.i denotes weight coefficients to be designed, i=1,2, . . . , m, m denotes a number of the singular values of V.sub.coupling.sub.mv, wherein the coupling weaken trajectory planning method, used to obtain the desired trajectory with the weakly coupling characteristic, is designed as: min J ( v , v , v 1 , v 2 , q , q , q .Math. ) = 1 S coupling ( v , v , v 2 , q , q , q .Math. ) + 2 D target ( v 1 , v 2 , q ) , wherein J(v, {dot over (v)}, .sub.v2, q, {dot over (q)}, {umlaut over (q)}) denotes an optimization function with respect to the desired trajectory v, {dot over (v)}, .sub.v1, .sub.v2, q, {dot over (q)}, {umlaut over (q)}. .sub.v1 denotes a position vector of the underwater vehicle, D.sub.target(.sub.v1, .sub.v2,q) denotes a distance between an end effector of the robotic arm and a target, .sub.1 and .sub.2 denote the weight coefficients to be designed.

9. A system for trajectory tracking control of a vehicle-manipulator coupling system with finite time prescribed performance, the system is applied to control a motion trajectory of the vehicle-manipulator coupling system, the vehicle-manipulator coupling system comprises an underwater vehicle and a robotic arm, and the system comprises: a parameter obtain unit, configured to obtain a present motion state and a desired trajectory with a weakly coupling characteristic of the vehicle-manipulator coupling system, so as to calculate a difference between the present motion state and the desired trajectory to obtain a trajectory tracking error; a performance function design unit, configured to design a finite time performance function to constrain the trajectory tracking error so that the vehicle-manipulator coupling system reaches a steady state in response to the trajectory tracking error converging to a preset convergence boundary; and a gradient of the finite time performance function is not zero in response to an operation time of the vehicle-manipulator coupling system exceeding a preset convergence time, so as to avoid generating a singularity in a calculation of the state of the vehicle-manipulator coupling system and to ensure that a controller of the vehicle-manipulator coupling system does not diverge; an error transformation unit, configured to convert the trajectory tracking error to obtain a corresponding transformed error in a case that constraint conditions corresponding to the finite time performance function are satisfied; a control input design unit, configured to design a sliding mode surface of the vehicle-manipulator coupling system based on the transformed error to control the transformed error to converge in a finite time, and observe an external disturbance of the vehicle-manipulator coupling system based on a non-linear disturbance observer and the sliding mode surface; and design a control input of the vehicle-manipulator coupling system based on the sliding mode surface and the external disturbance observer, so that the vehicle-manipulator coupling system is controlled to operate according to the desired trajectory; designing the control input of the vehicle-manipulator coupling system based on the sliding mode surface and the external disturbance observer specifically is: m = A m - 1 [ - B m - F ^ dm - - 1 ( H m + k .Math. s m .Math. 1 2 sign ( s m ) + 0 t k sign ( s m ( ) ) d ) ] , wherein .sub.m represents a control input, k.sub. and k.sub. represent controller parameters to be designed, sign(.Math.) represents a signum function, represents a time, s.sub.m() represents a value of s.sub.m at the time , s.sub.m represents the sliding mode surface, .sub.0.sup.tk.sub.sign(s.sub.m())d represents an integral of k.sub.sign(s.sub.m) at a time interval [0, t]; A.sub.m and B.sub.m represent a matrix related to a dynamics model of the vehicle-manipulator coupling system; {circumflex over (F)}.sub.dm represents observation of a unknown external disturbance; = ( u + l ) m 2 ( l m + e ) ( u m - e ) , .sub.l and .sub.u represent performance boundary coefficients, .sub.e represents the trajectory tracking error, .sub.m is an abbreviation of .sub.m(t), and .sub.m(t) represents a trajectory tracking error boundary; and H m = ( m + ) ( e - e . m m ) - .Math. . e . m m + e .Math. m m - e . m 2 m 2 - .Math. d , {dot over ()} represents a first order derivative of , {umlaut over ()}.sub.m is an abbreviation of {umlaut over ()}.sub.m(t) being a second order derivative of .sub.m(t), {umlaut over ()}.sub.d represents a second order derivative of the desired trajectory .sub.d, {dot over ()}.sub.e represents a first order derivative of the trajectory tracking error .sub.e, .sub.m represents a diagonal sliding mode surface coefficient matrix, and {dot over ()}.sub.m is an abbreviation of {dot over ()}.sub.m(t) being the first order derivative of .sub.m(t), wherein the control input includes control signals of the underwater vehicle and control signals of the robotic arm, the controller of the vehicle-manipulator coupling system is configured to: generate corresponding control forces by driving thrusters of the underwater vehicle based on the control signals of the underwater vehicle, and command joint motors of the robotic arm to output corresponding torques based on the control signals of the robotic arm, such that the robotic arm performs a grasping action after the underwater vehicle moves to a target position.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0053] FIG. 1 is a flow chart of a method for trajectory tracking control of a vehicle-manipulator coupling system with finite time prescribed performance according to an embodiment of the disclosure.

[0054] FIG. 2 is a schematic diagram of an underwater vehicle-manipulator system according to an embodiment of the disclosure.

[0055] FIG. 3 is a block diagram of the finite time prescribed performance control according to an embodiment of the disclosure.

[0056] FIG. 4 is a curve diagram of a trajectory tracking performance of the underwater robotic arm system according to an embodiment of the disclosure.

[0057] FIG. 5 is a curve diagram of a trajectory tracking error of the underwater robotic arm system according to an embodiment of the disclosure.

[0058] FIG. 6 is a curve diagram of a control input of the underwater robotic arm system according to an embodiment of the disclosure.

[0059] FIG. 7 is a curve diagram of an observation performance of a non-linear disturbance observer according to an embodiment of the disclosure.

[0060] FIG. 8 is a curve diagram of an observation error of the non-linear disturbance observer according to an embodiment of the disclosure.

[0061] FIG. 9 is a curve diagram of a dynamic coupling disturbance received by the underwater vehicle according to an embodiment of the disclosure.

[0062] FIG. 10 is a curve diagram of errors in the position tracking from dynamic positioning of the underwater vehicle according to an embodiment of the disclosure.

[0063] FIG. 11 is a curve diagram of errors in the attitude tracking from dynamic positioning of the underwater vehicle according to an embodiment of the disclosure.

[0064] FIG. 12 is a diagram of an architecture of a system for controlling the finite time prescribed performance of trajectory tracking of the vehicle-manipulator coupling system according to an embodiment of the disclosure.

[0065] FIG. 13 is a schematic diagram illustrating the underwater oil and gas production system operation and maintenance tasks based on the vehicle-manipulator coupling system according to embodiments.

[0066] FIG. 14 is a schematic diagram of the embodiment of the vehicle-manipulator coupling system for wheel-type valve operation testing according to the embodiments.

DESCRIPTION OF THE EMBODIMENTS

[0067] In order to make the purpose, technical solutions, and advantages of the disclosure more comprehensible, the disclosure will be further described in detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described here are merely used to explain the disclosure and the embodiments are not used to limit the disclosure.

[0068] The purpose of this disclosure is to, under the uncertainty, complex coupling disturbance, and unknown external disturbance of the model of the vehicle-manipulator coupling system, a control method is designed to realize the trajectory tracking control of the underwater vehicle-manipulator system, the trajectory tracking error should satisfy the preset transient-state and steady-state performance constraints, and the convergence time may be preset. In addition, the control method should have the ability to handle unknown external disturbances and weaken control buffeting to ensure the robustness and control precision of the vehicle-manipulator coupling system.

[0069] FIG. 1 is a flow chart of the trajectory tracking control of a vehicle-manipulator coupling system with finite time prescribed performance according to an embodiment of the disclosure. As shown in FIG. 1, the following steps are included.

[0070] S101. A present motion state and an desired trajectory of a vehicle-manipulator coupling system are obtained, so as to calculate a difference between the present motion state and the desired trajectory to obtain a trajectory tracking error. The desired trajectory is obtained by a proposed coupling weaken trajectory planning method.

[0071] A structure of an underwater vehicle-manipulator coupling system is shown in FIG. 2.

[0072] S102. A finite time performance function is designed to constrain the trajectory tracking error so that when the trajectory tracking error converges to a preset convergence boundary, the vehicle-manipulator coupling system reaches a steady state; and when an operation time of the vehicle-manipulator coupling system exceeds a preset convergence time, a gradient of the finite time performance function is not zero, so as to avoid generating a singularity in a calculation of the state of the vehicle-manipulator coupling system and to ensure that a controller of the vehicle-manipulator coupling system does not diverge.

[0073] S103. In a case that constraint conditions corresponding to the finite time performance function are satisfied, the trajectory tracking error is converted to obtain a corresponding transformed error.

[0074] S104. A sliding mode surface of the vehicle-manipulator coupling system is designed based on the transformed error to control the transformed error to converge in a finite time, and an external disturbance of the vehicle-manipulator coupling system is observed based on a non-linear disturbance observer and the sliding mode surface.

[0075] S105. A control input of the vehicle-manipulator coupling system is designed based on the sliding mode surface and the external disturbance observed, so that the vehicle-manipulator coupling system is controlled to operate according to the desired trajectory. The control input includes the control signals of the underwater vehicle and the control signals of the robotic arm. The controller of the vehicle-manipulator coupling system controls the thrusters of the underwater vehicle to output corresponding control forces based on the underwater vehicle's control signals, and controls the joint motors of the robotic arm to output corresponding torques based on the robotic arm's control signals. This enables the underwater vehicle to move to the target position, after which the robotic arm performs the grasping action.

[0076] Specifically, a method for controlling the finite time prescribed performance of a dynamic trajectory tracking task directed to the underwater vehicle-manipulator system according to the disclosure, as shown in FIG. 3, includes the following:

[0077] (1) An improved finite time performance function is proposed to constrain a trajectory tracking error of the system;

[0078] (2) An error transformation method directed to the performance function is designed; and (3) A super-twisting sliding mode control algorithm based on the improved finite time prescribed performance of the non-linear disturbance observer is designed.

[0079] The improved finite time performance function proposed is as follows:

[00019] m ( t ) = { ( 0 - t ) 1 / + c , 0 t < T m ( c - ) e - k ( t - T m ) + , t T m

[0080] In the formula, .sub.m(t) represents a trajectory tracking error boundary; .sub.0 represents a preset initial error boundary; .sub.c represents a trajectory tracking error preset convergence boundary; .sub. represents the trajectory tracking error asymptotic convergence boundary; , , k represent prescribed performance parameters, used to adjust a convergence rate and a convergence time of the performance function; e represents a natural constant; t represents a time process; and T.sub.m represents a convergence time of the performance function.

[0081] The improved finite time performance function has characteristics as follows:

[0082] (1) The convergence time T.sub.m of the finite time performance function is calculated as: T.sub.m=.sub.0.sup./(); (2) An actual initial error boundary of the finite time performance function is: .sub.m(0)=.sub.0+.sub.c; (3) When the trajectory tracking error converges to .sub.c, the system should reach a steady state. Therefore, when designing parameters, .sub.c should be designed to be small enough, usually 0.01, to satisfy the system convergence condition; (4) When the system time tT.sub.m is used, in order to ensure that the gradient of the performance function designed is not zero, the design range of .sub. is 0<.sub.<.sub.c.

[0083] The formula of the performance function constraining the system trajectory tracking error is:

[00020] el < e < eu

[0084] In the formula, .sub.e represents the system trajectory tracking error, and .sub.el and .sub.el represent a lower limit and an upper limit of the trajectory tracking error prescribed performance respectively and are defined by the following formula:

[00021] el = - k l m ( t ) , eu = k u m ( t )

[0085] In the formula, k.sub.l and k.sub.u represent performance boundary coefficients, and values thereof are in a range of 0<k.sub.11 and in a range of 0<k.sub.u1 respectively. The system trajectory tracking error is defined as:

[00022] e = - d

[0086] In the formula, .sub.e represents the trajectory tracking error, represents a system motion state, and .sub.d represents a system desired trajectory.

[0087] An error transformation method is represented by the following formula:

[00023] S ( ) = k u e - k l e - e + e -

[0088] In the formula, .sub. represents an transformed system error, e represents the natural constant, S represents the error transformation method, and there are:

[00024] S ( ) = e m

[0089] Therefore, below is obtained:

[00025] = S ( e m ) - 1 = 1 2 ln + k l k u -

[0090] In the formula, custom-character=.sub.e/.sub.m.

[0091] For the super-twisting sliding mode control algorithm based on the improved finite time prescribed performance of the non-linear disturbance observer proposed, the design process is as follows.

[0092] Firstly, the system model expression is given:

[00026] { x 1 = x 2 x 2 = A m m + B m + F dm

[0093] In the formula, x.sub.1= represents a system position state vector, x.sub.2 represents a system speed state vector, A.sub.m and B.sub.m represent a matrix related to a dynamics model of the system, F.sub.dm represents the external disturbance unknown received by the system, and .sub.m represents a control input of the system.

[0094] Secondly, the sliding mode surface S.sub.m is designed based on the transformed error .sub.:

[00027] S m = m +

[0095] In the formula, .sub.m represents a diagonal sliding mode surface coefficient matrix.

[0096] Further, since F.sub.dm is the unknown external disturbance, the non-linear disturbance observer is designed as follows to perform real-time estimation on F.sub.dm:

[00028] { F d m = d m + K d m S m d m = - L d m d m - L d m ( K d m S m + - 1 H m + A m m + B m )

[0097] In the formula, {circumflex over (F)}.sub.dm represents the observation of the unknown external disturbance, .sub.dm represents an auxiliary intermediate variable of the non-linear disturbance observer, K.sub.dm represents a gain coefficient of the observer to be designed, and K.sub.dm satisfies K.sub.dm=L.sub.dm.sup.1.

[0098] Finally, the control algorithm is designed according to the following:

[00029] m = A m - 1 [ - B m - F d m - - 1 ( H m + k .Math. s m .Math. 1 2 sign ( s m ) + 0 t k sign ( s m ( ) ) d ) ]

[0099] In the formula, k.sub. and k.sub. represent controller parameters to be designed.

[0100] It should be noted that the design idea of the control algorithm is as follows. The super-twisting sliding mode control approaching law is adopted so that the transformed error converges within a finite time and that the system tracking error ne satisfies the prescribed performance convergence boundary, and the system chattering effect can be weakened. The non-linear disturbance observer is introduced to improve system robustness under system uncertainty and external disturbance.

[0101] The disclosure uses the following embodiment to verify the above technical solution.

[0102] Basic parameters of the underwater vehicle-manipulator system according to an embodiment are shown in Table 1.

TABLE-US-00001 TABLE 1 Basic parameters of the underwater vehicle-manipulator system Parameter name Parameter description Parameter value M.sub.v Underwater vehicle mass 226 kg L.sub.v Underwater vehicle length 1.2 m D.sub.v Underwater vehicle 0.6 m equivalent diameter G.sub.v Underwater vehicle gravity 2217N B.sub.v Underwater vehicle buoyancy 2217N I.sub.v, xx Underwater vehicle moment 8 kg .Math. m.sup.2 of inertia-X I.sub.v, yy Underwater vehicle moment 20 kg .Math. m.sup.2 of inertia-Y I.sub.v, zz Underwater vehicle moment 20 kg .Math. m.sup.2 of inertia-Z M.sub.1 Robotic arm link 1 mass 3.39 kg M.sub.2 Robotic arm link 2 mass 3.39 kg L.sub.1 Robotic arm link 1 length 0.5 m L.sub.2 Robotic arm link 2 length 0.5 m D.sub.1 Robotic arm link 1 diameter 0.16 m D.sub.2 Robotic arm link 2 diameter 0.16 m C.sub.m Inertia coefficient 1.0 C.sub.d Drag coefficient 1.1 Water density 1000 kg .Math. m.sup.3 g Acceleration of gravity 9.8 m .Math. s.sup.2

[0103] This embodiment uses simulation to illustrate the effectiveness and advancement of the method proposed by this disclosure. In the simulation, the underwater vehicle completes a dynamic positioning control task, and the robotic arm mounted thereon completes complex sinusoidal motion to reflect the effectiveness of the control method proposed by this disclosure. Next, simulation parameter settings are introduced. For the dynamic positioning task of the underwater vehicle, an initial pose is

[00030] v , 0 = [ 1 m 0 m 0.5 m 0 . 1 2 rad 0 . 1 2 rad 0 . 3 2 rad ] T ,

and an expected pose is .sub.v,d=[3 m 3 m 4 m 0 rad 0 rad 0 rad].sup.T. For the robotic arm trajectory tracking task, an initial joint angle is q.sub.0=[0rad 0rad].sup.T, and the expected joint angle changes with time t as

[00031] q d = [ - 0 . 5 - 4 sin ( t ) rad - 0.5 - 4 sin ( t ) rad ] T .

In the control parameter aspect, for the robotic arm system, parameters are designed follows: =0.4, =0.8, k=0.2, .sub.0=[2 2], .sub.c=[0.03 0.03].sup.T, .sub.=[0.02 0.02].sup.T, .sub.u=1, .sub.l=0.7, .sub.m=diag(0.05,0.05), k.sub.=diag(25,25), k.sub.=diag(20,20). For the underwater vehicle, control parameters are designed follows: =0.2, =0.8, k=0.3, .sub.0=[6 6 6 1 1 1].sup.T, .sub.c=[0.15 0.15 0.15 0.1 0.1 0.1].sup.T, .sub.=[0.1 0.1 0.1 0.05 0.05 0.05].sup.T, .sub.u=1, .sub.l=1, .sub.m=diag(0.1,0.1,0.1,0.1,0.1,0.1), .sub.=diag(500,500,500,400,400,400), .sub.=diag(300,300,300,300,300,300), in which diag represents the diagonal matrix. The external disturbance received by the system is set to d.sub.1=3+8sin(0.6 t)+5cos(0.3 t), and d.sub.2=4+7sin(0.7 t)+4 cos(0.2 t). A parameter of the non-linear disturbance observer in the robotic arm system is designed as L.sub.dm=diag(20,18), and a parameter of the observer of the underwater vehicle is designed as L.sub.dm=diag(100,100,100,100,100,100).

[0104] The simulation results are shown in FIG. 4 to FIG. 11. FIG. 4 shows trajectory tracking results of the robotic arm with two joints, and FIG. 5 shows trajectory tracking errors of the two joints. The simulation results show that the convergence time of the method proposed by this disclosure is less than 4 s, the convergence is fast, and the convergence time is controllable. In addition, the trajectory tracking steady-state error of the method according to the disclosure is less than 0.01 rad. The Calculation shows that for a joint 1 and a joint 2, average steady-state tracking errors of the method according to the disclosure are 6.3010.sup.4 rad and 2.3310.sup.3 rad respectively, and the control precision is high.

[0105] FIG. 6 shows control inputs of the joint 1 and the joint 2. It may be concluded from FIG. 6 that when the method according to the disclosure is adopted, the chattering effect is significantly weakened. FIG. 7 and FIG. 8 show the observation performance of the non-linear disturbance observer, the observer may stably estimate external disturbance, and the observation values may converge in a short time. Specifically, the average steady-state estimation errors of disturbance 1 and disturbance 2 are 4.1810.sup.2 Nm and 1.2910.sup.2 Nm respectively. Finally, the dynamic positioning control performance of the underwater vehicle is briefly demonstrated. When working together with the robotic arm, the underwater vehicle is affected by the dynamic coupling effect. Since the robotic arm of 2 degrees of freedom merely operates in an xoz plane of an underwater vehicle boat body coordinate system, the dynamic coupling effect merely affects three degrees of freedom, x, z, and of the underwater vehicle, as shown in FIG. 9. FIG. 10 and FIG. 11 respectively show dynamic positioning position errors and attitude errors of the underwater vehicle under the action of external disturbance and coupling disturbance, in which steady-state position errors on three degrees of freedom, x, y, z, are respectively 1.3910.sup.4 m, 3.0510.sup.3 m, 4.3010.sup.4 m, and steady-state attitude errors on three degrees of freedom , , are respectively 9.2110.sup.3 rad, 1.4210.sup.2 rad, 2.0510.sup.4 rad, the control precision is high, and the convergence time is fast, approximately 4 s. The above analysis shows that the method proposed by the disclosure has good transient-state and steady-state control performances.

[0106] In summary, the disclosure discloses the method for the finite time prescribed performance control of the dynamic trajectory tracking task directed to the underwater vehicle-manipulator system. Under the influence of model uncertainty, dynamic coupling effects, and external disturbances, the trajectory tracking control of the underwater vehicle-manipulator systems faces big challenges. In order to ensure the transient-state and steady-state performances of the system, the improved finite time performance function is designed to ensure that the preset tracking precision is achieved in a specified convergence time. The performance function proposed can avoid generating a singularity in the system, and the robustness of the system is improved. In order to reduce the influence of unknown external disturbances on the system, the non-linear disturbance observer is adopted to process unknown disturbances. Finally, the super-twisting sliding mode control framework based on the improved finite time prescribed performance of the non-linear disturbance observer is proposed, which ensures the control precision, robustness, and transient-state performance of the system, and the buffeting phenomenon is weakened.

[0107] FIG. 12 is a diagram of an architecture of a system for the finite time prescribed performance control of trajectory tracking for the vehicle-manipulator coupling system according to an embodiment of the disclosure. As shown in FIG. 12, the control system includes the following.

[0108] A parameter obtain unit 1210 is used to obtain the present motion state and the desired trajectory of the vehicle-manipulator coupling system, so as to calculate a difference between the present motion state and the desired trajectory to obtain a trajectory tracking error.

[0109] A performance function design unit 1220 is used to design a finite time performance function to constrain the trajectory tracking error so that when the trajectory tracking error converges to a preset convergence boundary, the vehicle-manipulator coupling system reaches a steady state, and when an operation time of the vehicle-manipulator coupling system exceeds a preset convergence time, a gradient of the finite time performance function is not zero, so as to avoid generating a singularity in a calculation of the state of the vehicle-manipulator coupling system and to ensure that a controller of the vehicle-manipulator coupling system does not diverge.

[0110] An error transformation unit 1230 is used to convert the trajectory tracking error to obtain the corresponding transformed error in a case that constraint conditions corresponding to the finite time performance function are satisfied.

[0111] A control input design unit 1240 is used to design the sliding mode surface of the vehicle-manipulator coupling system based on the transformed error to control the transformed error to converge in a finite time, and to observe the external disturbance of the vehicle-manipulator coupling system based on the non-linear disturbance observer and the sliding mode surface; and to design the control input of the vehicle-manipulator coupling system based on the sliding mode surface and external disturbance observed, so that the vehicle-manipulator coupling system is controlled to operate according to the desired trajectory.

[0112] It should be understood that the control system is used to execute the method in the embodiments, and corresponding program units in the control system have implementation principles and technical effects similar to the contents described in the method. For the working process of the control system, reference may be made to corresponding processes in the method described above, and details will not be repeated here.

[0113] The following uses the operation and maintenance tasks of the underwater oil and gas production system as the application scenario for the vehicle-manipulator coupling system. FIG. 13 is a schematic diagram illustrating the operation and maintenance tasks of the underwater oil and gas production system according to the embodiment of the present disclosure. In this embodiment, an underwater vehicle-manipulator system (UVMS) 1300 serves as the vehicle-manipulator coupling system.

[0114] The UVMS 1300 includes an underwater vehicle 1310 (mother craft) and a robotic arm 1320 according to FIG. 13. As shown in FIG. 13, the operational workspace of the UVMS 1300 is narrow and complex. If only steady-state control accuracy is ensured, the UVMS 1300 may collide with underwater structures before reaching steady state due to excessive control overshoot, slow convergence rate, and the intricate underwater environment. Therefore, it is essential to guarantee excellent transient performance of the UVMS 1300, constraining its state within a global safety envelope to avoid collisions with underwater structures while strictly controlling the convergence time.

[0115] If conventional finite-time prescribed performance functions are used, the gradient of the performance function becomes zero once the UVMS 1300 reaches steady state. In such a case, if the UVMS 1300 is subjected to strong impulsive disturbances and its state approaches or crosses the prescribed performance boundary, the control algorithmlacking a performance function gradientwill encounter singularities, leading to control divergence. This results in uncontrollable system states, increasing collision risks and potentially causing mission failure or system damage.

[0116] To address this issue, the finite-time performance function designed in this embodiment incorporates preset convergence boundary technology, ensuring global non-singularity of the UVMS 1300. This effectively resolves the control divergence problem that conventional finite-time prescribed performance control systems are prone to after reaching steady state.

[0117] FIG. 14 is a schematic diagram of the embodiment of the vehicle-manipulator coupling system for wheel-type valve operation testing according to the embodiments. In this embodiment, a real-vehicle test was conducted based on a simulated operational scenario of control panel 1400 in the maintenance tasks of a subsea oil and gas production system. First, the underwater vehicle 1310 achieves visual-servo dynamic hovering using the wheel-type valve 1410 as a reference. Then, as the underwater vehicle 1310 approaches the control panel 1400, the wheel-type valve 1410 gradually enters the operational workspace of the vehicle-manipulator coupling system 1300. The robotic arm 1320, based on visual positioning information and combined with the proposed coupling-weakened trajectory planning method, generates a desired trajectory with weakly coupled characteristics to approach the wheel-type valve 1410 and accomplish precise grasping. Finally, the end-effector (e.g., the gripper at the end of the robotic arm 1320) rotates 90 degrees clockwise to complete the valve-turning operation.

[0118] For example, the target coordinates of the wheel-type valve 1410's center in the binocular camera coordinate system of underwater vehicle 1310 are set to [0.4 m, 0.05 m, 0 m], with both the target roll and pitch angles of underwater vehicle 1310 set to 0. Subsequently, underwater vehicle 1310 maneuvers toward control panel 1400 to approach it. When underwater vehicle 1310 has moved toward control panel 1400 for 15.6 seconds, control panel 1400 enters the operational range of vehicle-manipulator coupling system 1300. At this point, robotic arm 1320 initiates movement and approaches wheel-type valve 1410. Under the control of vehicle-manipulator coupling system 1300's controller, underwater vehicle 1310 effectively counteracts coupling disturbances induced by the weakly-coupled robotic arm 1320's motion. The vehicle maintains high positioning accuracy and stability throughout the operation, with all positioning errors constrained within the safety performance envelope. Although a steady-state tracking error of 0.035 m persists along the z-axis, and maximum pitch angle fluctuations of 0.57 occur after robotic arm 1320 begins to move, these deviations are actively compensated by robotic arm 1320 without compromising precise capture of the target (wheel-type valve 1410).

[0119] During the time interval of 15.6 s to 28.6 s, robotic arm 1320 gradually approaches the center of wheel-type valve 1410 based on visual perception data and achieves precise grasping. Valve rotation commences at 33.6 s, with the wheel-type valve 1410 rotation task successfully completed in 4.6 seconds.

[0120] In other embodiments, the vehicle-manipulator coupling system is used for a T-type valve, and its related operations are similar to those of the wheel-type valve 1410, which will not be described in detail here.

[0121] The disclosure provides a coupling weaken trajectory planning method for reducing the dynamic coupling effect of the vehicle-manipulator coupling system. Firstly, the dynamic equation of the vehicle-manipulator coupling system can be written as follows:

[00032] M v . + C ( v ) v + D v ( v ) v + G v ( 2 ) - M mv , q ( q ) q .Math. - M mv , v ( q ) v - C mv ( q , q . , v ) - D mv ( q , q . , v ) - G mv ( q , 2 ) = 0.

[0122] Where M.sub.v includes a rigid body inertia matrix and an added mass inertia matrix of the underwater vehicle, C.sub.v(v) includes a vehicle coriolis centripetal force matrix of rigid body and a coriolis centripetal force matrix of added mass, D.sub.v(v) denotes a damping matrix of the underwater vehicle, G.sub.v(.sub.v2) denotes a gravity and a buoyancy of the underwater vehicle, M.sub.mv,q(q) denotes a coupling inertial matrix induced by an acceleration of the robotic arm, C.sub.mv(q,{dot over (q)},v) denotes a coupling coriolis centripetal force and a moment acting on the underwater vehicle induced by the coupling velocity of the robotic arm and the underwater vehicle, D.sub.mv(q,{dot over (q)},v) denotes a coupling damping force and a moment acting on the vehicle induced by the coupling velocity of the robotic arm and the underwater vehicle, G.sub.mv(q,.sub.v2) denotes a coupling buoyancy and a gravity force and a moment of the robotic arm acting on the underwater vehicle. The parameters of the above matrices can be obtained by an empirical formula of the hydrodynamics or the towing test. v denotes a velocity vector of the underwater vehicle, .sub.v2 denotes an attitude vector of the underwater vehicle. Both of them can be obtained by an onboard attitude sensor, such as the inertial measurement unit (IMU). {dot over (v)} denotes an acceleration vector of the underwater vehicle, which can be obtained by a velocity differentiation process. q denotes a joint angle vector of the robotic arm, {dot over (q)} denotes a joint angular velocity vector of the robotic arm, {umlaut over (q)} denotes a joint angular acceleration vector of the robotic arm. The above three parameters can be obtained by a motor encoder of each joint.

[0123] The dynamic equation of the vehicle-manipulator coupling system can be transformed into:

[00033] [ M - M mv , v ( q ) ] v . = [ ( C mv ( q , q . , v ) + D mv ( q , q . , ) + G mv ( q , v 2 ) - C v ( v ) v - D v ( v ) v - G v ( 2 ) ) q .Math. + M m , q ( q ) ] q .Math. .

[0124] Where {umlaut over (q)}.sup. denotes a normalized inverse vector of the joint angular acceleration, which is designed as:

[00034] q .Math. = [ q .Math. 1 .Math. q .Math. .Math. 2 , q .Math. 2 .Math. q .Math. .Math. 2 , .Math. , q n .Math. q .Math. .Math. 2 ] .

[0125] Where n denotes the number of the joints of the robotic arm, {umlaut over (q)}.sub.i(with i=1,2, . . . , n) denotes the i.sup.th joint acceleration of the robotic arm. Then the following equation can be obtained:


{dot over (v)}=V.sub.coupling.sub.mv{umlaut over (q)}.

[0126] Where V.sub.coupling.sub.mv is designed as a coupling characteristic index, which can be written as:

[00035] V c o upling mv = V c v - 1 V c m . Where : V c v = M v - M mv , v ( q ) .Math. V c m = [ C m v ( q , q , v ) + D m v ( q , q , v ) + G m v ( q , v 2 ) - C v ( v ) v - D v ( v ) v - G v ( v 2 ) ] q .Math. + M mv , q ( q )

[0127] The provided coupling characteristic index V.sub.coupling.sub.mv reveals the motion coupling relationship between the robotic arm and the underwater vehicle. In order to quantify the coupling effects of the vehicle-manipulator coupling system, a singular value decomposition of V.sub.coupling.sub.mv is conducted, and a weighted average for each singular value can be obtained as S.sub.coupling, which is related to the system trajectory characteristic v, {dot over (v)}, .sub.v2, q, {dot over (q)}, {umlaut over (q)}. Then it can be written as S.sub.coupling(v, {dot over (v)}, .sub.v2, q, {dot over (q)}, {umlaut over (q)}), and technicians can know that the smaller S.sub.coupling(v, {dot over (v)}, .sub.v2, q, {dot over (q)}, {umlaut over (q)}), a weakly coupling characteristic can be got. Then, the coupling weaken trajectory planning method can be designed as:

[00036] min J ( v , v . , v 1 , v 2 , q , q , q .Math. ) = 1 S coupling ( v , v . , v 2 , q , q , q .Math. ) + 2 D target ( v 1 , v 2 , q ) .

[0128] Where J(v, {dot over (v)}, .sub.v2, q, {dot over (q)}, {umlaut over (q)}) denotes an optimization function with respect to the desired trajectory v, {dot over (v)}, .sub.v1, .sub.v2, q, {dot over (q)}, {umlaut over (q)}, .sub.v1 denotes a position vector of the underwater vehicle, which can be obtained by a camera system. D.sub.target(.sub.v1,.sub.v2,q) denotes a distance between an end effector of the robotic arm and the target, which can be obtained by the camera system. The coupling weaken trajectory planning method is to find the minimum value of J(v, {dot over (v)}, .sub.v2, q, {dot over (q)}, {umlaut over (q)}), then the desired trajectory with weakly coupling characteristic can be obtained.

[0129] Based on the method according to the embodiments, an electronic device is provided according to an embodiment of the disclosure. The device may include at least one storage device for storing programs and at least one processor for executing the programs stored in the storage device, in which when the program stored in the storage device is executed, the processor is used to execute the method according to the embodiments.

[0130] Based on the method according to the embodiments, a computer-readable storage medium is provided according to an embodiment of the disclosure. The computer-readable storage medium stores a computer program, in which when the computer program is run on the processor, the processor executes the method according to the embodiments.

[0131] Based on the method according to the embodiments, a computer program product is provided according to an embodiment of the disclosure. When the computer program product is run on the processor, the processor executes the method according to the embodiments.

[0132] It may be understood that the processor in the embodiments of the disclosure may be a central processing unit (CPU), or other general-purpose processor, digital signal processor (DSP), application specific integrated circuit (ASIC), field programmable gate array (FPGA), or other programmable logic devices, transistor logic devices, hardware components, or any combination thereof. The general-purpose processor may be a microprocessor or any regular processor.

[0133] The steps in the method according to the embodiments of the disclosure may be implemented by hardware or by the processor executing software commands. The software commands may comprise corresponding software modules, and the software modules may be stored in random access memory (RAM), flash memory, read-only memory (ROM), programmable rom (PROM), erasable PROM (EPROM), electrically EPROM (EEPROM), register, hard disk, portable storage device, CD-ROM, or any other forms of storage medium well known in the art. An exemplary storage medium is coupled to a processor so that the processor may read information from the storage medium and write information to the storage medium. Certainly, the storage medium may also be an integral part of the processor. The processor and the storage medium may be located in the ASIC.

[0134] The above embodiments may be implemented in whole or in part by software, hardware, firmware, or any combination thereof. When implemented using software, the disclosure may be implemented in whole or in part in the form of a computer program product. The computer program product includes one or more computer commands. When the computer program commands are loaded and executed on a computer, the processes or functions described in the embodiments of the disclosure are generated in whole or in part. The computer may be a general-purpose computer, a special-purpose computer, a computer network, or other programmable devices. The computer command may be stored in the computer-readable storage medium or transmitted over the computer-readable storage medium. The computer command may be transmitted from a website, computer, server, or data center via wired (such as coaxial cable, optical fiber, digital subscriber line (DSL)) or wireless (such as infrared, wireless, microwave) transmission to another website, computer, server, or data center. The computer-readable storage medium may be any available medium accessible by a computer, or a data storage device such as and integrated server comprising one or more available media, for example, a server or a data center. The available medium may be a magnetic medium (for example, a floppy disk, a hard disk, a magnetic tape), an optical medium (for example, a DVD), or a semiconductor medium (for example, a solid state disk (SSD)).

[0135] It may be understood that the various reference numerals involved in the embodiments of the disclosure are merely for convenience of description and are not used to limit the scope of the embodiments of the disclosure.

[0136] It may be understood for persons skilled in the art that the embodiments are merely some preferred embodiments of the disclosure and the embodiments are not intended to limit the disclosure. Any modifications, equivalent substitutions, and improvements made within the spirit and principles of the disclosure shall be regarded as should be included within the protection scope of the disclosure.