Distributed unmanned ship formation change formation control method based on state quantification
Through state quantization and improved communication topology mode, the problem of network blockage and control complexity in the unmanned boat fleet control system is solved, and the rapid and flexible transformation and efficient communication of the unmanned boat fleet is realized, which improves system stability and network utilization are improved. Rate.
Patent Information
- Application Number
- CN202411120922.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-15
- Publication Date
- 2024-11-12
AI Technical Summary
The existing unmanned boat fleet control system has problems of network blockage, packet loss and control complexity in data transmission and processing, especially when the formation is large, and the unmanned boat is disturbed by wind, waves and flow, resulting in System stability and security are affected.
Using state quantization distributed unmanned boat formation transformation formation control method, through improved communication topology mode and uniform quantizer model, you only need to locate the position of the leader of the unmanned boat formation to obtain the affine position of the follower, reducing the Communication costs and bandwidth, reduce power consumption of hardware systems, and construct unmanned boat speed observers and controllers to achieve formation transformation.
It significantly reduces the network communication frequency, improves the system's network utilization rate, realizes fast and flexible formation transformation, reduces the number of communications of unmanned boats, and improves the formation's tracking ability and system stability.
Smart Images

Figure CN118938926A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to a technology in the field of unmanned equipment control, in particular to a state quantized distributed unmanned boat formation transformation control method. Background Art
[0002] Most of the existing unmanned boat hardware systems are based on digital technology, which means that data is transmitted at a fixed period during algorithm design and hardware sampling. These data are often discrete changes rather than continuous information. Quantization can discretize continuous state quantities. At the same time, quantization errors can be modeled and analyzed during the design process to reduce the impact of quantization errors on system stability and safety. When the size and number of unmanned boat formations are large, if TCP / UDP network communication is carried out through networking radio stations, the network with limited bandwidth cannot simultaneously receive and transmit a large amount of data, and network congestion or information packet loss often occur. In addition, the mathematical model of unmanned boats involves complex nonlinear characteristics. The strong coupling characteristics of hydrodynamic parameters and unmanned boat state information will make the design process of unmanned boat controllers very complicated. At the same time, unmanned boats will undoubtedly suffer from unknown interference such as wind, waves and currents during navigation. Therefore, the above problems need to be predicted and compensated in the controller design process. Summary of the invention
[0003] In view of the above-mentioned deficiencies in the prior art, the present invention proposes a state-quantized distributed unmanned boat formation transformation control method. By introducing an improved communication topology mode and taking into account the stress constraints between members, the affine positioning position of the follower can be obtained by simply locating the position of the leader in the unmanned boat formation. At the same time, considering the communication cost and communication bandwidth, the state information of the unmanned boat is quantized, and the continuous time-varying state information is converted into a discrete set, which reduces the memory occupied by the storage and processing of the digital system and reduces the power consumption of the hardware system.
[0004] The present invention is achieved through the following technical solutions:
[0005] The present invention relates to a state quantized distributed unmanned boat formation transformation control method. An unmanned boat mathematical model is established, a uniform quantizer model and an affine formation expected trajectory are defined, an unmanned boat speed observer and an unmanned boat controller are constructed, and after simulation verification, the simulation results are deployed in an unmanned boat fleet control system.
[0006] The present invention relates to a system for implementing the above method, comprising: an expected formation definition unit, a controller design unit and a quantitative communication management unit, wherein: the expected formation definition unit defines different expected formations and position changes according to different task types and task characteristics, and deploys the expected position of each member in a respective processor; the controller design unit calculates the error of its own state and calculates the relevant control force and torque according to the information of A; the quantitative communication management unit determines whether to update the own state of each member through the module and decides when to transmit information. Technical Effects
[0007] The present invention aims at the control of unmanned boat formation, takes into account the control of intermittent communication during the shape change process, uses state quantization technology to effectively reduce the frequency of network communication, significantly reduces unnecessary data transmission in network communication, and can quickly and flexibly change the formation. BRIEF DESCRIPTION OF THE DRAWINGS
[0008] Figure 1 It is a flow chart of the present invention;
[0009] Figure 2 is the stress matrix of the unmanned boat formation;
[0010] Figure 3 Simulate and verify the formation change of unmanned boats;
[0011] Figure 4 Control forces and moments for each member of the unmanned boat formation;
[0012] Figure 5 is the discrete communication interval between the 1st and 2nd followers;
[0013] Figure 6 The discrete communication interval for the 3rd and 4th followers. DETAILED DESCRIPTION
[0014] like Figure 1 As shown, this embodiment relates to a state quantized distributed unmanned boat formation transformation control method, including:
[0015] Step 1: Considering the three degrees of freedom of the surface unmanned boat, namely, sway, swing and pitch, the kinematic and dynamic models of the unmanned boat are constructed as follows: Where: η i =[p i ,ψ i ] T is the absolute position and heading angle of the i-th unmanned boat in the fixed coordinate system, R(ψ i ) is the transformation matrix between the fixed coordinate system and the body coordinate system, and the positive definite matrix M i is the inertial mass matrix, C i is the Coriolis force matrix, Di is the damping force matrix, τ i is the control input of each unmanned boat, d i This is the unknown external interference encountered by the unmanned boat.
[0016] To facilitate controller design, the mathematical model of the unmanned boat's kinematics and dynamics is changed to: in: The control input includes the inertia matrix and the rotation matrix, and the cross product matrix Considering that the reference signal of the unmanned boat formation system is given by the virtual boat η0, the trajectory of the virtual boat is generated by dynamics Where: η0=[x0,y0,ψ0] T is the position vector of the virtual leader in the geodetic coordinate system, v0 = [u0, v0, r0] T In its own coordinate system is the velocity vector under. R(ψ0) is the corresponding rotation matrix.
[0017] In the kinematic and dynamic models of the unmanned boat, the various state information of the unmanned boat (including position, heading angle, linear velocity, and angular velocity) are all continuously and smoothly changing, and no sudden changes can occur. The external interference suffered by the unmanned boat has an upper bound. Considering that the energy in the sea area is limited, the unknown external force it is subjected to is bounded. The expected trajectory of the formation leader should be planned to be smooth and continuous, so as to ensure that the trajectory of the follower is also smooth and continuous.
[0018] Step 2: Construct a mathematical model of uniform quantizer, specifically: q u :→, for a given quantization step size β u , the uniform quantizer satisfies: |q u (a)-a|≤β u , Where: q u represents the quantized control instruction, and a represents the unquantized instruction information.
[0019] Step 3: Construct the expected trajectory of the affine formation, including:
[0020] 3.1 For any formation configuration, its affine span is in: is the i-th node coordinate, and the dimension of the affine span is the same as the span in the translation vector space, which is defined as Therefore, the dimension of the affine span in Euclidean space is
[0021] 3.2 Calculate the transformation set of the affine formation: Among them: A(t) is for rotation, scaling and shearing operations, b(t) is for translation operations. According to different task requirements, the formation transformation is adjusted to complete the rotation and shearing tasks, and b(t) is defined in the host computer to complete the translation instructions of the unmanned boat. The unmanned boat can be sheared, rotated, translated or scaled in the plane to adapt to different complex sea areas and islands.
[0022] 3.3 In the formation transformation, when the stress of the entire formation is in equilibrium, the stress of each side should satisfy Where: The stress on each edge is The corresponding stress set is the equilibrium value of the ideal configuration, and the stress matrix corresponding to the equilibrium stress set is
[0023] 3.4 Considering the formation framework of leaders and followers, the stress matrix is divided into: For any matrix is positive definite, p f Can be The only certainty.
[0024] 3.5 In the unmanned boat maneuvering formation based on affine transformation, the position of each follower will be uniquely determined according to the relative position of the leader, that is, the overall configuration of the formation is changed by changing the position of the leader during the transformation process. Therefore, the expected position of the follower in affine positioning is Where: The position of the leader of the unmanned boat η l , l is the number of leaders,
[0025] 3.6 The control objective is to construct: under the leadership-follower organizational framework, each member of the formation reaches the expected position based on the basic requirements of affine transformation to meet the characteristics of formation configuration and formation change.
[0026] Step 4: Construct an unmanned boat speed observer, including:
[0027] 4.1 The speed and position are estimated using the state observer, specifically: Where: State error Estimated value of state Estimated external interference value α i1 and α i2 All are positive numbers to be set.
[0028] 4.2 Consider the derivation of the Lyapunov energy function with respect to time, specifically: Where: Lyapunov energy function That is, under the action of the proposed observer, the system can be regionally stable within a finite time.
[0029] Step 5: Construct the unmanned boat controller, specifically: Among them: Unmanned boat formation coordination position error and speed error k is the positive definite diagonal matrix to be designed, and the position error information of the unmanned boat follower is the expected position of the i-th unmanned boat, and the derivative of the coordination error with respect to time is Lyapunov function The Lyapunov equation is differentiated with respect to time:
[0030] The unmanned boat controller will only transmit the quantitative information of its own state to its neighbors through the communication network when it changes. At other times, it only uses the state information of the neighbors at the last update time, thereby avoiding continuous communication between the members of the unmanned boat formation. This means that the system is stable and the system error can converge to a stable area.
[0031] Step six, by simulating the unmanned boat controller constructed in step five, that is, defining the desired formation and generating the corresponding desired position information, and then embedding the desired position information into the processor of the unmanned boat to realize the formation transformation of the unmanned boat formation.
[0032] After specific practical experiments, under the MATLAB environment setting, 7 unmanned boat formation members were used, of which 3 were virtual leaders and the remaining 4 were followers for numerical simulation verification. The model parameter definition of the unmanned boat is shown in Table 1:
[0033] Table 1. Parameters of unmanned boat model
[0034] Compared with the existing technology, this method can significantly reduce the communication frequency between unmanned boats while ensuring the integrity of the formation configuration. In the simulation verification process, the number of continuous communications between unmanned boats is 27,500 times, but under this algorithm, the number of communications of each unmanned boat is only 4580, 2506 times, which can reduce the communication frequency of unmanned boats by 83% and reduce the load of network communication. The present invention only achieves the formation transformation of the entire formation by changing the position information of a few leaders in the formation. Through simulation experiments, it can be verified that the unmanned boat has good formation tracking ability under the action of the proposed controller, such as Figure 5 and Figure 6 As shown, the communication frequency and communication interval between members of the unmanned boat formation will be greatly optimized.
[0035] In summary, compared with the prior art, the present invention discretizes the state information of the unmanned boat itself through quantitative communication, and calculates and determines when the unmanned boat transmits state information to its neighbors according to the protocol, thereby reducing the transmission of repeated information in network communication and improving the utilization rate of the system network. Compared with the existing formation control method of unmanned boats, the present invention can make the formation switching more flexible and accurate, and can complete the formation transformation under the premise of less changes in system information.
[0036] The above-mentioned specific implementation can be partially adjusted in different ways by those skilled in the art without departing from the principle and purpose of the present invention. The protection scope of the present invention shall be based on the claims and shall not be limited by the above-mentioned specific implementation. Each implementation scheme within its scope shall be subject to the constraints of the present invention.
Claims
1. A state quantified distributed unmanned boat formation change control method, It is characterized in that By establishing the mathematical model of the unmanned boat, defining the uniform quantizer model and the expected trajectory of the affine formation, constructing the unmanned boat speed observer and the unmanned boat controller and verifying them through simulation, the simulation results are deployed in the control system of the unmanned boat fleet.
2. According to the state quantization distributed unmanned boat formation transformation control method of claim 1, Its characteristics are: The mathematical model of the unmanned boat is a kinematic and dynamic model of the unmanned boat constructed by considering the three degrees of freedom of the surface unmanned boat, namely, the swaying, swinging and bow pitching. Specifically, it is: Where: η i =[p i ,ψ i ] T is the absolute position and heading angle of the i-th unmanned boat in the fixed coordinate system, R(ψ i ) is the transformation matrix between the fixed coordinate system and the body coordinate system, and the positive definite matrix M i is the inertial mass matrix, C i is the Coriolis force matrix, D i is the damping force matrix, τ i is the control input of each unmanned boat, d i This is the unknown external interference encountered by the unmanned boat.
3. The state quantized distributed unmanned boat formation transformation control method according to claim 1 or 2, Its characteristics are: The mathematical model of the unmanned boat changes to: in: The control input includes the inertia matrix and the rotation matrix, and the cross product matrix Considering that the reference signal of the unmanned boat formation system is composed of the virtual boat η 0 Given, the trajectory of the virtual boat generated by dynamics Where: η 0 =[x 0 ,y 0 ,ψ 0 ] T is the position vector of the virtual leader in the geodetic coordinate system, v 0 =[u 0 ,v 0 ,r 0 ] T In its own coordinate system The velocity vector under 0 ) is the corresponding rotation matrix.
4. According to the state quantization distributed unmanned boat formation transformation control method of claim 1, Its characteristics are: The uniform quantizer model is specifically: u :→, for a given quantization step size β u , the uniform quantizer satisfies: |q u (a)-a|≤β u , Where: q u represents the quantized control instruction, and a represents the unquantized instruction information.
5. According to the state quantization distributed unmanned boat formation change control method of claim 1, Its characteristics are: The desired trajectory of the affine formation is constructed in the following way: 3.1 For any formation configuration, its affine span is in: is the i-th node coordinate, the dimension of the affine span is the same as the span in the translation vector space, which is defined as dim(S), so the dimension of the affine span in Euclidean space is dim(S) = 2; 3.2 Calculate the transformation set of the affine formation: Among them: A(t) is for rotation, scaling and shearing operations, b(t) is for translation operations. According to different task requirements, the formation transformation set A(t) is adjusted to complete the rotation and shearing tasks, and b(t) is defined in the host computer to complete the translation instructions of the unmanned boat; arbitrary shearing, rotation, translation or scaling operations on the unmanned boat in the plane can adapt to different complex sea areas and islands; 3.3 In the formation transformation, when the stress of the entire formation is in equilibrium, the stress of each side should satisfy Where: The stress on each edge is The corresponding stress set is the equilibrium value of the ideal configuration, and the stress matrix corresponding to the equilibrium stress set is 3.4 Considering the formation framework of leaders and followers, the stress matrix is divided into: For any matrix is positive definite, p f Can be The only certainty; 3.5 In the unmanned boat maneuvering formation based on affine transformation, the position of each follower will be uniquely determined according to the relative position of the leader, that is, the overall configuration of the formation is changed by changing the position of the leader during the transformation process. Therefore, the expected position of the follower in affine positioning is Where: The position of the leader of the unmanned boat η l , l is the number of leaders; 3.6 The control objective is to construct: under the leadership-follower organizational framework, each member of the formation reaches the expected position based on the basic requirements of affine transformation to meet the characteristics of formation configuration and formation change.
6. The state quantized distributed unmanned boat formation transformation control method according to claim 1 is characterized in that the unmanned boat speed observer is constructed in the following manner: 4.1 The speed and position are estimated using the state observer, specifically: Where: State error Estimated value of state Estimated external interference value α i1 and α i2 All are positive numbers to be set; 4.2 Consider the derivation of the Lyapunov energy function with respect to time, specifically: Where: Lyapunov energy function That is, under the action of the proposed observer, the system can be regionally stable within a finite time.
7. The state quantized distributed unmanned boat formation transformation control method according to claim 1, Its characteristics are: The unmanned boat controller is constructed in the following way: Among them: Unmanned boat formation coordination position error and speed error k is the positive definite diagonal matrix to be designed, and the position error information of the unmanned boat follower is the expected position of the i-th unmanned boat, and the derivative of the coordination error with respect to time is Lyapunov function The Lyapunov equation is differentiated with respect to time: The unmanned boat controller will only transmit the quantitative information of its own state to its neighbors through the communication network when the quantitative information of its own state changes. At other times, it only uses the state information of the neighbors at the last update time, thereby avoiding continuous communication between the members of the unmanned boat formation, which means that the system is stable and the system error can converge to a stable area.
8. The state quantized distributed unmanned boat formation transformation control method according to claim 7, Its characteristics are: The deployment refers to: by simulating and calculating the constructed unmanned boat controller, that is, generating corresponding expected position information after defining the expected formation, and then embedding the expected position information in the processor of the unmanned boat to realize the formation transformation of the unmanned boat formation.
9. A distributed unmanned boat formation transformation control system for implementing the state quantization of the method described in any one of claims 1 to 8, It is characterized in that include: An expected formation definition unit, a controller design unit and a quantitative communication management unit, wherein: the expected formation definition unit defines different expected formations and position changes according to different task types and task characteristics, and deploys the expected position of each member in its own processor; the controller design unit calculates the error of its own state and the relevant control force and torque according to the information of A; the quantitative communication management unit uses this module to determine whether to update the state of each member and decide when to transmit information.
Citation Information
Patent Citations
Model-free fully-distributed unmanned ship cooperative time-varying formation control method based on body coordinate system
CN114879657A
Distributed affine unmanned ship formation controller construction method based on event triggering and unmanned ship formation control method
CN115617039A
Unmanned ship course tracking control method with state / input quantization
CN116540728A
Unmanned ship track tracking control method with input / state quantification
CN117055566A
Unmanned ship adaptive trajectory tracking control method with input quantization and state quantization
CN117872736A
Cited By
Memory cache mechanism-based unmanned ship formation maneuvering control method considering intermittent communication failure
CN120803060A
