A method and system for maintaining ship formation based on autonomous switching of navigators

By dynamically switching the navigator and calculating the formation deviation, the instability problem caused by the ship formation maintenance method relying on the navigator in the prior art is solved, and the formation robustness and low-cost formation recovery are achieved.

CN118584965BActive Publication Date: 2024-11-12CHINA STATE SHIPBUILDING CORP NO 707 RES INST
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411069657.3
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-08-06
Publication Date
2024-11-12
Estimated Expiration
2044-08-06

AI Technical Summary

Technical Problem

The existing ship formation and formation maintenance methods rely too much on the navigator, resulting in the entire formation control stagnation or high cost, and the formation cannot be effectively maintained when the navigator fails, loses control or has too large control errors.

Method used

Using the method based on the autonomous switching of the navigator, by calculating the formation deviation of the ship formation and dynamically switch the navigator to ensure that the formation can be restored to the expected formation at the minimum position, providing data collection, formation deviation calculation, and navigator determination and the motion command generation module to realize the independent navigator switching of the formation.

Benefits of technology

It improves the robustness of the formation and formation recovery cost, avoids the risk of instability in the fixed navigator mode, and ensures that the formation can quickly and at low cost to restore the desired formation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118584965B_ABST
    Figure CN118584965B_ABST
Patent Text Reader

Abstract

The present invention relates to the technical field of ship formation motion control, and specifically discloses a method and system for maintaining the formation of a ship formation based on autonomous switching of a navigator, the method comprising: obtaining the desired formation, current position and actual speed of the ship formation; according to the desired formation and current position of the ship formation, taking the navigator and the follower as the topological relationship center respectively, calculating the formation deviation of the formation; according to the formation deviation, determining the navigator of the ship formation at the next moment; the desired formation, and the current position and actual speed of the navigator of the ship formation at the next moment, generating motion instructions for all the followers. The present invention can autonomously switch the navigator of the formation according to the real-time control state of the formation, so that all members of the formation can restore to the desired formation with the minimum position cost.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of ship formation motion control, and in particular to a ship formation formation maintaining method and system based on autonomous switching of a navigator. Background Art

[0002] In the field of marine engineering, ships are performing increasingly complex tasks, such as platform mining, submerged tube installation, emergency rescue, underwater survey and salvage, etc. Given the limitations of a single ship in terms of lifting, equipment configuration, and carrying capacity, the collaborative operation scenarios of ship formations are becoming more and more extensive, especially in the field of unmanned ships. It has become a widely recognized consensus that multi-agent systems can complete more complex tasks at a lower cost than single agents.

[0003] Maintaining the formation of a fleet of ships is of great significance in the entire process of maritime operations. Its essence is to control the consistency problem, that is, to keep the topological relationship between all ships consistent during movement and operation. The current formation maintenance strategies mainly include the pilot-follower method, the behavior-based method, the virtual structure method, the graph theory method, etc.

[0004] The pilot following method is the most commonly used formation keeping method. Its basic principle is: the formation is based on the motion state of the pilot, so that the position and attitude errors of the follower and the pilot converge to the expected value, so that the entire formation can achieve the predetermined formation keeping, and the formation control is converted into tracking control to solve it. For example, the Chinese invention patent with application publication number CN117193322A discloses a method and device for maintaining a ship formation. The method includes: adjusting the force field of the follower ship at every preset interval, including: determining the expected position of the follower ship according to the current position of the pilot ship and the formation formation; calculating the gravity to be applied to the follower ship according to the current position of the follower ship and the expected position of the follower ship; calculating the force field of the follower ship according to the gravity of the follower ship, so as to apply the force field to the follower ship to maintain the formation formation. The patent considers the formation queue of the ship as a whole, determines the expected position of each follower ship, and thus plans the path of each follower ship to maintain the formation formation.

[0005] The core idea of ​​the pilot-following method is that the follower maintains the relative position and attitude topological relationship with the pilot. The disadvantage of this method is that it is overly dependent on the pilot's status: (1) When the pilot fails, loses control, or fails, the entire formation control will stagnate, resulting in mission failure; (2) When the pilot himself has a large control error, it will cause all other followers to passively follow, resulting in a high formation maintenance cost. Summary of the invention

[0006] The present invention aims to solve the problem that the fixed pilot mode may cause the entire formation to become unstable when the pilot loses control, fails, or has too large an error. To this end, the present invention provides a method and system for maintaining the formation of a ship formation based on autonomous switching of the pilot, which is suitable for the formation maintenance control of manned and unmanned ship formations, and can autonomously switch the pilot of the formation according to the real-time control state of the formation, so that all members of the formation can restore to the desired formation with the minimum position cost. It has an important and irreplaceable role in the field of ship formation maintenance that is significantly different from other methods.

[0007] The present invention provides a method for maintaining a ship formation based on autonomous switching of a navigator, and the technical solution adopted is as follows: comprising:

[0008] Obtain the expected formation, current position and actual speed of the fleet;

[0009] According to the expected formation and current position of the ship formation, the navigator and the follower are respectively used as the topological relationship center to calculate the formation deviation;

[0010] Determining the navigator of the ship formation at the next moment according to the formation deviation degree;

[0011] According to the desired formation, and the current position and actual speed of the navigator of the ship formation at the next moment, motion instructions are generated for all the followers, and the followers travel according to the motion instructions so that the followers and the navigator of the ship formation at the next moment maintain the desired formation.

[0012] Furthermore, the ship formation adopts a pilot-follower mode. At any time, there is only one ship in the ship formation that is the pilot, and the remaining ships are followers.

[0013] Furthermore, the calculation formula of the formation deviation is:

[0014]

[0015] in, The first ship in the fleet The formation deviation when the ship is the center of the topological relationship, is the total number of ships in the fleet, For the fleet of ships The ship's position points to The expected value of the plane vector of the ship's position, For the fleet of ships The ship's position points to The actual value of the plane vector of the ship's position.

[0016] Furthermore, according to the formation deviation degree, the process of determining the navigator of the ship formation at the next moment is as follows:

[0017] According to all the formation deviations, the minimum deviation is calculated. and the average deviation ;

[0018] Assume The ship is the pilot at the current moment, The formation deviation of the ships is ;like , then the navigator is switched, and the navigator of the fleet at the next moment is The corresponding ship, otherwise, does not switch the pilot, where Indicates the switching parameters.

[0019] Furthermore,

[0020]

[0021] in, Respectively represent the 1st, 2nd, ..., The formation deviation of the ships.

[0022] Furthermore, .

[0023] Furthermore, the motion instruction includes a position instruction and a speed instruction, specifically:

[0024]

[0025] in, Indicates the first ship in the fleet Position instructions for ships, Indicates the actual position of the navigator of the fleet at the next moment, Indicates that the navigator position of the ship formation at the next moment points to the The expected value of the plane vector of the ship's position; Indicates the first ship in the fleet The speed instruction of the ship, Indicates the actual speed of the navigator of the fleet at the next moment.

[0026] The present invention also provides a ship formation maintenance system based on autonomous switching of a navigator, and the technical scheme adopted is as follows: comprising: a data acquisition module, a formation deviation calculation module, a navigator determination module and a motion instruction generation module, wherein the data acquisition module, the formation deviation calculation module, the navigator determination module and the motion instruction generation module are connected in sequence, and the data acquisition module is connected to the motion instruction generation module.

[0027] The data acquisition module is used to obtain the expected formation, current position and actual speed of the ship formation;

[0028] The formation deviation calculation module is used to calculate the formation deviation according to the expected formation and current position of the ship formation, taking the navigator and the follower as the topological relationship center respectively;

[0029] The pilot determination module is used to determine the pilot of the ship formation at the next moment according to the formation deviation degree;

[0030] The motion instruction generating module is used to generate motion instructions for all the followers according to the desired formation, and the current position and actual speed of the navigator of the ship formation at the next moment. The followers travel according to the motion instructions so that the followers maintain the desired formation with the navigator of the ship formation at the next moment.

[0031] The above one or more technical solutions in the embodiments of the present invention have at least one of the following technical effects:

[0032] 1. The formation recovery cost of the present invention is the lowest: based on the topological relationship between followers and navigators, the present invention calculates the formation deviation when all ships in the current formation act as navigators respectively, and designs navigator switching rules, thereby ensuring that the formation can quickly recover to the desired formation at the overall shortest position cost, which is significantly different from other formation control strategies.

[0033] 2. The present invention has better formation robustness: When the error of the current navigator is too large, the present invention can calculate the significant increase in the formation deviation when the current navigator is the topological center, and determine whether he is suitable to continue to serve as the navigator according to the navigator switching rules. This avoids the risk of the navigator losing control, failing, or having too large an error in the fixed navigator mode, which leads to the instability of the entire formation.

[0034] Additional aspects and advantages of the present invention will be given in part in the following description and in part will be obvious from the following description, or will be learned through practice of the present invention. BRIEF DESCRIPTION OF THE DRAWINGS

[0035] In order to more clearly illustrate the technical solutions in the present invention or the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0036] Figure 1 It is a flow chart of the method provided by the present invention.

[0037] Figure 2 It is a schematic diagram of the expected formation of the ship formation provided by the present invention.

[0038] Figure 3 It is a schematic diagram of each ship in the ship formation provided by the present invention as a topological relationship center.

[0039] Figure 4 It is a structural block diagram of the system provided by the present invention.

[0040] Reference numerals:

[0041] 1. Data acquisition module; 2. Formation deviation calculation module; 3. Navigator determination module; 4. Movement instruction generation module. DETAILED DESCRIPTION

[0042] In order to make the purpose, technical scheme and advantages of the present invention clearer, the technical scheme of the present invention will be clearly and completely described below in conjunction with the drawings in the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, rather than all the embodiments. Based on the embodiments in the present invention, all other embodiments obtained by ordinary technicians in the field without creative work are within the scope of protection of the present invention. The following embodiments are used to illustrate the present invention, but cannot be used to limit the scope of the present invention.

[0043] In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "example", "specific example", or "some examples" etc. means that the specific features, structures or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the embodiment of the present invention. In this specification, the schematic representations of the above terms do not necessarily refer to the same embodiment or example. Moreover, the specific features, structures or characteristics described may be combined in any one or more embodiments or examples in a suitable manner. In addition, those skilled in the art may combine and combine the different embodiments or examples described in this specification and the features of the different embodiments or examples, without contradiction.

[0044] The core idea of ​​the pilot-following method is that the follower maintains the relative position and posture topological relationship with the pilot. It has the following disadvantages: (1) When the pilot fails, loses control, or fails, the entire formation control will stagnate, resulting in the failure of the task; (2) When the pilot himself has a large control error, it will cause all other followers to passively follow, resulting in a high formation maintenance cost. The present invention proposes a formation deviation index to evaluate whether it is reasonable for the current pilot to continue to serve as the topological center of the ship formation; it also proposes a pilot switching rule. Under the premise of stable control, based on the minimum overall cost of the formation, the pilot identity is switched in a timely manner to quickly restore the formation.

[0045] Combine the following Figures 1 to 4 The present invention is further described in detail, and a method and system for maintaining a ship formation based on autonomous switching of a navigator is described as follows:

[0046] In this embodiment, Figure 1 As shown, a method for maintaining a ship formation based on autonomous switching of a navigator is provided, comprising the following steps:

[0047] Step 1: Obtain the desired formation, current position and actual speed of the ship formation.

[0048] The ship formation adopts a pilot-follower mode. At any time, there is only one ship in the ship formation that is a pilot, and the remaining ships are followers.

[0049] Step 2: According to the expected formation and current position of the ship formation, the navigator and the follower are respectively used as the topological relationship center to calculate the formation deviation.

[0050] The calculation formula of the formation deviation is:

[0051]

[0052] in, The first ship in the fleet The formation deviation when the ship is the center of the topological relationship, is the total number of ships in the fleet, For the fleet of ships The ship's position points to The expected value of the plane vector of the ship's position, For the fleet of ships The ship's position points to The actual value of the plane vector of the ship's position. According to the expected formation, Calculated based on the current position.

[0053] Step 3: Determine the navigator of the ship formation at the next moment according to the formation deviation. The specific process is:

[0054] According to all the formation deviations, the minimum deviation is calculated. and the average deviation . Represents the deviation of all the formations; assuming that The ship is the navigator at the current moment, and its formation deviation is ,but

[0055]

[0056]

[0057] in, Respectively represent the 1st, 2nd, ..., The formation deviation of the ships.

[0058] like , then the navigator is switched, and the navigator of the fleet at the next moment is The corresponding ship, otherwise, does not switch the pilot, that is, when At the next moment, the navigator of the fleet is still No. Ships. Among them, Indicates the switching parameter, which is manually adjustable. In this embodiment, .

[0059] Step 4: Generate motion instructions for all the followers based on the desired formation, as well as the current position and actual speed of the navigator of the ship formation at the next moment. The followers drive according to the motion instructions so that the followers and the navigator of the ship formation at the next moment maintain the desired formation.

[0060] The motion command includes position command and speed command, and the calculation formula is:

[0061]

[0062] in, Indicates the first ship in the fleet Position instructions for ships, Indicates the actual position of the navigator of the fleet at the next moment, Indicates that the navigator position of the ship formation at the next moment points to the The expected value of the plane vector of the ship's position, Obtained according to the desired formation; Indicates the first ship in the fleet The speed instruction of the ship, Indicates the actual speed of the navigator of the fleet at the next moment.

[0063] The implementation process of this method is explained below with reference to a specific fleet of three ships:

[0064] The fleet consists of three ships, namely ship A, ship B and ship C. The expected formation of the fleet is as follows: Figure 2 As shown, specifically, the coordinates of ship A are (1,1), the coordinates of ship B are (0,0), and the coordinates of ship C are (1,0), and the three form an isosceles right triangle in the two-dimensional plane.

[0065] At a certain moment, the current positions of the ships in the fleet are: the current navigator is ship A, the actual coordinates of ship A are (7, 6), the actual coordinates of ship B are (5, 5), and the actual coordinates of ship C are (6.2, 5). At this time, the formation has been deformed.

[0066] The formation deviation of each ship can be calculated based on the expected formation and current position. Figure 3 As shown in (a), ship A is used as the topological center to calculate its formation deviation ;like Figure 3 As shown in (b), ship B is used as the topological center to calculate its formation deviation ;like Figure 3 As shown in (c), ship C is used as the topological center to calculate its formation deviation .

[0067] According to the formation deviation of the three ships, we can calculate

[0068]

[0069] .

[0070] According to the pilot switching rules, ,and ( ), indicating that at this time, ship A has a large individual error in the overall formation and is not suitable to continue to serve as the navigator. The navigator needs to be switched to ship C, that is, the navigator of the ship formation at the next moment is ship C.

[0071] According to the calculation formula of the follower's position command and speed command

[0072] ,

[0073] Based on the current position (6.2,5) of the new pilot ship C, it is calculated that the position instruction of ship A at the next moment is (6.2,6), and the position instruction of ship B at the next moment is (5.2,5); the speed instructions of both should be equal to the speed vector of the new pilot ship C.

[0074] In this embodiment, Figure 4 As shown, a ship formation maintaining system based on autonomous switching of the navigator is also provided, and the technical scheme adopted is as follows: it includes: a data acquisition module 1, a formation deviation calculation module 2, a navigator determination module 3 and a motion instruction generation module 4, the data acquisition module 1, the formation deviation calculation module 2, the navigator determination module 3 and the motion instruction generation module 4 are connected in sequence, and the data acquisition module 1 is connected to the motion instruction generation module 4.

[0075] The data acquisition module 1 is used to obtain the expected formation, current position and actual speed of the ship formation;

[0076] The formation deviation calculation module 2 is used to calculate the formation deviation according to the expected formation and current position of the ship formation, taking the navigator and the follower as the topological relationship center respectively;

[0077] The pilot determination module 3 is used to determine the pilot of the ship formation at the next moment according to the formation deviation degree;

[0078] The motion instruction generating module 4 is used to generate motion instructions for all the followers according to the desired formation, and the current position and actual speed of the navigator of the ship formation at the next moment. The followers drive according to the motion instructions so that the followers maintain the desired formation with the navigator of the ship formation at the next moment.

[0079] The workflow of this system is:

[0080] The data acquisition module 1 obtains the expected formation, current position and actual speed of the ship formation, and sends the expected formation and current position to the formation deviation calculation module 2, and sends the expected formation, current position and actual speed to the motion instruction generation module 4.

[0081] The formation deviation calculation module 2 calculates the formation deviation according to the expected formation and current position of the ship formation, taking the navigator and the follower as the topological relationship center respectively. The calculation formula of the formation deviation is:

[0082]

[0083] in, The first ship in the fleet The formation deviation when the ship is the center of the topological relationship, is the total number of ships in the fleet, For the fleet of ships The ship's position points to The expected value of the plane vector of the ship's position, For the fleet of ships The ship's position points to The actual value of the plane vector of the ship's position. According to the expected formation, Calculated based on the current position.

[0084] The number of formation deviations calculated by the formation deviation calculation module 2 is the same as the total number of ships in the ship formation. The formation deviation calculation module 2 sends all formation deviations to the pilot determination module 3.

[0085] The pilot determination module 3 calculates the minimum deviation according to all the formation deviations. and the average deviation Then determine the new navigator according to the navigator switching rules: if , then the navigator is switched, and the navigator of the fleet at the next moment is The corresponding ship, otherwise, does not switch the pilot, where Then the navigator of the fleet at the next moment is sent to the motion instruction generating module 4.

[0086] The motion instruction generating module 4 determines the previous position and actual speed of the ship formation according to the navigator of the next moment, and then calculates the

[0087]

[0088] Generate movement instructions for all followers. Indicates the first ship in the fleet The position command of the follower, Indicates the actual position of the navigator of the fleet at the next moment, Indicates that the navigator position of the ship formation at the next moment points to the The expected value of the plane vector of the follower position, Obtained according to the desired formation; Indicates the first ship in the fleet The speed command of the follower, The actual speed of the navigator of the fleet of ships at the next moment is represented. The follower travels according to the motion instruction so that the follower and the navigator of the fleet of ships at the next moment maintain the desired formation.

[0089] The system periodically acquires data, determines whether it is necessary to switch the navigator, and generates motion instructions for all the followers.

[0090] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some of the technical features therein. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present invention.

Claims

1. A method for maintaining ship formation based on autonomous switching of navigators. It is characterized in that include: Obtain the expected formation, current position and actual speed of the fleet; According to the expected formation and current position of the ship formation, the navigator and the follower are respectively used as the topological relationship center to calculate the formation deviation; The calculation formula of the formation deviation is: in, The first ship in the fleet The formation deviation when the ship is the center of the topological relationship, is the total number of ships in the fleet, For the fleet of ships The ship's position points to The expected value of the plane vector of the ship's position, For the fleet of ships The ship's position points to The actual value of the plane vector of the ship's position; Determining the navigator of the ship formation at the next moment according to the formation deviation degree; According to the formation deviation degree, the process of determining the navigator of the ship formation at the next moment is: According to all the formation deviations, the minimum deviation is calculated. and the average deviation ; Assume The ship is the pilot at the current moment, The formation deviation of the ships is ;like , then the navigator is switched, and the navigator of the fleet at the next moment is The corresponding ship, otherwise, does not switch the pilot, where Indicates switching parameters; According to the desired formation, and the current position and actual speed of the navigator of the ship formation at the next moment, motion instructions are generated for all the followers, and the followers travel according to the motion instructions so that the followers and the navigator of the ship formation at the next moment maintain the desired formation.

2. A method for maintaining a ship formation based on autonomous switching of a navigator as claimed in claim 1, It is characterized in that The ship formation adopts a pilot-follower mode. At any time, there is only one ship in the ship formation that is a pilot, and the remaining ships are followers.

3. A method for maintaining a ship formation based on autonomous switching of a navigator as claimed in claim 1, It is characterized in that in, Respectively represent the 1st, 2nd, ..., The formation deviation of the ships.

4. A method for maintaining a ship formation based on autonomous switching of a navigator as claimed in claim 1, It is characterized in that 。 5. A method for maintaining a ship formation based on autonomous switching of a navigator as claimed in claim 1 or 2, It is characterized in that The motion instructions include position instructions and speed instructions, specifically: in, Indicates the first ship in the fleet Position instructions for ships, Indicates the actual position of the navigator of the fleet at the next moment, Indicates that the navigator position of the ship formation at the next moment points to the The expected value of the plane vector of the ship's position; Indicates the first ship in the fleet The speed instruction of the ship, Indicates the actual speed of the navigator of the fleet at the next moment.

6. A ship formation maintenance system based on autonomous switching of the navigator, It is characterized in that A method for maintaining a ship formation based on autonomous switching of a navigator is used to execute any one of claims 1 to 5, comprising: a data acquisition module, a formation deviation calculation module, a navigator determination module and a motion instruction generation module, wherein the data acquisition module, the formation deviation calculation module, the navigator determination module and the motion instruction generation module are connected in sequence, and the data acquisition module is connected to the motion instruction generation module. The data acquisition module is used to obtain the expected formation, current position and actual speed of the ship formation; The formation deviation calculation module is used to calculate the formation deviation according to the expected formation and current position of the ship formation, taking the navigator and the follower as the topological relationship center respectively; The calculation formula of the formation deviation is: in, The first ship in the fleet The formation deviation when the ship is the center of the topological relationship, is the total number of ships in the fleet, For the fleet of ships The ship's position points to The expected value of the plane vector of the ship's position, For the fleet of ships The ship's position points to The actual value of the plane vector of the ship's position; The pilot determination module is used to determine the pilot of the ship formation at the next moment according to the formation deviation degree; According to the formation deviation degree, the process of determining the navigator of the ship formation at the next moment is: According to all the formation deviations, the minimum deviation is calculated. and the average deviation ; Assume The ship is the pilot at the current moment, The formation deviation of the ships is ;like , then the navigator is switched, and the navigator of the fleet at the next moment is The corresponding ship, otherwise, does not switch the pilot, where Indicates switching parameters; The motion instruction generating module is used to generate motion instructions for all the followers according to the desired formation, and the current position and actual speed of the navigator of the ship formation at the next moment. The followers travel according to the motion instructions so that the followers maintain the desired formation with the navigator of the ship formation at the next moment.