An unmanned target ship control system based on position data

Through the unmanned target ship control system based on location data, the navigation speed control and collision warning are used to control the navigation speed and prevent the unmanned target ship's navigation speed adjustment and obstacle avoidance safety in the prior art is solved. , improve navigation safety and work safety.

CN118605353BActive Publication Date: 2024-11-05DALIAN XU CHU INT TRADE CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

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

AI Technical Summary

Technical Problem

The existing unmanned target ship control system has safety hazards in speed regulation and obstacle avoidance. It relies on manual operation and has high professionalism and high load, which can easily lead to fatigue and errors.

Method used

Using a control system based on location data, the real-time reference navigation speed is calculated by obtaining real-time marking maps, obstacle density values, wave undulation height difference and unmanned target ship deviation angles, and the real-time reference navigation speed is controlled, and the obstacle analysis and The collision warning module realizes automatic obstacle avoidance.

Benefits of technology

Effectively avoiding the problem of inefficient manual control, improving the navigation safety of unmanned target ships, reducing collision risks, and improving work safety.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118605353B_ABST
    Figure CN118605353B_ABST
Patent Text Reader

Abstract

The invention discloses an unmanned target ship control system based on position data, relates to the field of ship control, and solves the problem of poor control effect of the existing unmanned target ship control system. The position acquisition module is used to acquire a real-time position marking map, the speed control module is used to acquire a real-time reference navigation speed of the unmanned target ship according to the real-time position marking map, and the navigation speed of the unmanned target ship is controlled, the obstacle avoidance analysis module is used to perform obstacle analysis on the unmanned target ship according to the real-time position marking map to obtain obstacle analysis data, and the collision warning module is used to perform collision warning control on the unmanned target ship according to the real-time position marking map, the real-time reference navigation speed of the unmanned target ship and the obstacle analysis data. The invention can effectively avoid the problems of low control efficiency and insufficient safety caused by manual control of the speed of the unmanned target ship.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the field of ship control and relates to a positioning technology, in particular to an unmanned target ship control system based on position data. Background Art

[0002] An unmanned target ship is a ship that does not require human control and can autonomously navigate, dock, turn, and perform other actions. Unmanned target ships are usually equipped with various sensors and control systems, which can realize functions such as autonomous navigation, obstacle avoidance, and execution of specific tasks. In the fields of marine scientific research, offshore operations, marine monitoring, and military, unmanned target ships can play the role of target ships and are used for tasks such as target tracking, weapon testing, and training exercises. The emergence of unmanned target ships can effectively reduce personnel risks, reduce costs, and improve operational efficiency;

[0003] The existing unmanned target ship control system has the following defects:

[0004] 1. Existing unmanned target ships often rely on manual remote control to adjust their speed during operation. When they are damaged by external forces at the target range, manual operation cannot accurately control the speed according to the operation status of the unmanned target ship, which leads to certain navigation safety hazards for the unmanned target ship.

[0005] 2. Existing unmanned target ships require staff to monitor the ship's surroundings and take obstacle avoidance measures, which places high demands on the staff's professional level and workload, and factors such as fatigue and errors may affect the operation effect.

[0006] To this end, we propose an unmanned target ship control system based on position data. Summary of the invention

[0007] In view of the deficiencies in the prior art, the purpose of the present invention is to provide an unmanned target ship control system based on position data. The present invention is based on obtaining a real-time position marking map, obtaining an obstacle density value according to the real-time position marking map, obtaining the horizontal deviation angle of the unmanned target ship, the reference navigation speed of the unmanned target ship, the real-time navigation speed of the unmanned target ship and the real-time wave fluctuation height difference to calculate the real-time reference navigation speed of the unmanned target ship, controlling the real-time navigation speed of the unmanned target ship according to the real-time reference navigation speed of the unmanned target ship, judging the motion state of the obstacle according to the real-time position marking map to obtain obstacle motion judgment classification data, and obtaining the real-time moving speed of each moving obstacle to obtain the real-time moving speed data of the moving obstacle, defining the obstacle motion judgment classification data and the real-time moving speed data of the moving obstacle as obstacle analysis data, and performing collision warning control on the unmanned target ship according to the real-time position marking map, the real-time reference navigation speed of the unmanned target ship and the obstacle analysis data;

[0008] In order to achieve the above object, the present invention adopts the following technical scheme to implement, a specific working process of each module of an unmanned target ship control system based on position data is as follows:

[0009] Position acquisition module: obtain the target ship navigation sea area geographic information map, target ship sea area plane rectangular coordinate system, target ship environment detection area, preset detection distance and the plane rectangular coordinate corresponding to each obstacle, mark the target ship sea area plane rectangular coordinate system, target ship environment detection area, preset detection distance and the plane rectangular coordinate corresponding to each obstacle on the target ship navigation sea area geographic information map to obtain a real-time position marking map;

[0010] Speed ​​control module: Obtain the obstacle density value according to the real-time location mark map, obtain the horizontal deviation angle of the unmanned target ship, the reference navigation speed of the unmanned target ship, the real-time navigation speed of the unmanned target ship and the real-time wave height difference to calculate the real-time reference navigation speed of the unmanned target ship, and control the real-time navigation speed of the unmanned target ship according to the real-time reference navigation speed of the unmanned target ship;

[0011] Obstacle avoidance analysis module: the obstacle motion state is judged according to the real-time position mark map to obtain obstacle motion judgment classification data, and the real-time moving speed of each moving obstacle is acquired to obtain the real-time moving speed data of the moving obstacle. The obstacle motion judgment classification data and the real-time moving speed data of the moving obstacle are defined as obstacle analysis data;

[0012] Collision warning module: performs collision warning control on the unmanned target ship based on the real-time location marking map, the real-time benchmark navigation speed of the unmanned target ship, and obstacle analysis data.

[0013] Furthermore, it also includes a database, and the data stored in the database includes a geographic information map of the target ship's navigation area;

[0014] The location acquisition module acquires the location real-time marked map as follows:

[0015] Extracting the target ship navigation sea area geographic information map and the preset detection distance from the database, the unmanned target ship acquires its own latitude and longitude coordinates through the first data acquisition device, and marks them on the target ship navigation sea area geographic information map to obtain the target ship coordinate marking point;

[0016] In the target ship navigation sea area geographic information map, the target ship coordinate mark point is used as the coordinate origin. In the target ship navigation sea area geographic information map, a straight line running east-west through the coordinate origin is marked as the coordinate X axis, and a straight line running north-south through the coordinate origin is marked as the coordinate Y axis. The plane rectangular coordinate system composed of the coordinate origin, the coordinate X axis and the coordinate Y axis is marked as the target ship sea area plane rectangular coordinate system;

[0017] Extract the preset detection distance from the database, take the target ship coordinate mark point as the center of the circle, and the preset detection distance as the radius, mark the detection distance mark circle in the plane rectangular coordinate system of the target ship sea area, and obtain the target ship environment detection area;

[0018] Conduct obstacle detection in the target ship environment detection area and obtain the longitude and latitude coordinates of multiple obstacles;

[0019] The longitude and latitude coordinates of multiple obstacles are marked on the target ship navigation area geographic information map, and are converted into plane rectangular coordinates through the target ship sea area plane rectangular coordinate system to obtain the plane rectangular coordinates corresponding to each obstacle;

[0020] The plane rectangular coordinates corresponding to each obstacle are synchronized in the plane rectangular coordinate system of the target ship sea area;

[0021] The target ship navigation area geographic information map which marks the target ship sea area plane rectangular coordinate system, target ship environment detection area, preset detection distance and plane rectangular coordinates corresponding to each obstacle is positioned as a real-time position marking map.

[0022] Furthermore, the position acquisition module acquires the latitude and longitude coordinates of multiple obstacles, as follows:

[0023] Obtain the real-time draft depth of the unmanned target ship and obtain the reference depth value for underwater object detection;

[0024] dividing the target ship environment detection area into a first type detection area and a second type detection area;

[0025] For the first type of detection area, the unmanned target ship uses the second data acquisition device to obtain the depth of the subsurface objects in the target ship environment detection area from the water surface, obtains multiple depth values ​​of the objects from the water surface, and compares the multiple depth values ​​of the objects from the water surface with the underwater object detection reference depth values. When the object depth value from the water surface is less than the underwater object detection reference depth value, it is judged that the underwater object is a first type of obstacle, and the real-time longitude and latitude coordinates of the multiple first type obstacles are respectively obtained to obtain the longitude and latitude coordinates of the multiple obstacles;

[0026] For the second type of detection area, the unmanned target ship detects objects above the water surface in the target ship environment detection area through the third data acquisition device, marks the objects above the water surface as second type obstacles, and acquires the real-time longitude and latitude coordinates of multiple second type obstacles to obtain the longitude and latitude coordinates of multiple obstacles;.

[0027] Furthermore, the speed control module obtains the real-time reference navigation speed of the unmanned target ship to control the navigation speed of the unmanned target ship, as follows:

[0028] Get obstacle density value;

[0029] The details are as follows:

[0030] Obtaining a real-time marked map of the location, and obtaining the quantity of the first type of obstacles and the second type of obstacles according to the real-time marked map of the location, to obtain the quantity value of the first type of obstacles and the quantity value of the second type of obstacles;

[0031] The preset detection distance is obtained through the real-time location mark map, and the preset detection distance, the number of first-type obstacles and the number of second-type obstacles are calculated to obtain the obstacle density value corresponding to the target ship environment detection area;

[0032] Place a height monitoring float in the sea area around the unmanned target ship, obtain the wave fluctuation cycle closest to the current time as the real-time wave fluctuation cycle, obtain the maximum height value and the minimum height value corresponding to the height monitoring float in the real-time wave fluctuation cycle, calculate the difference between the maximum height value and the minimum height value, and obtain the real-time wave fluctuation height difference;

[0033] Obtain the horizontal deviation angle of the unmanned target ship;

[0034] The details are as follows:

[0035] Taking the current time point as the reference time point, randomly mark m / 2 horizontal monitoring time points with the same time interval before the reference time, and randomly mark m / 2 horizontal monitoring time points with the same time interval after the reference time, to obtain m horizontal monitoring time points, which are named the first to the mth horizontal monitoring time points respectively;

[0036] The horizontal tilt angle values ​​corresponding to the first to mth horizontal monitoring time points are respectively acquired by the fourth data acquisition device to obtain the first to mth horizontal tilt angle values, and the first to mth horizontal tilt angle values ​​are averaged to obtain the horizontal real-time deviation angle of the unmanned target ship;

[0037] Obtain the baseline navigation speed of the unmanned target ship;

[0038] The real-time reference navigation speed of the unmanned target ship is calculated by the reference navigation speed of the unmanned target ship, the obstacle density value, the real-time wave height difference and the real-time horizontal deviation angle of the unmanned target ship to obtain the real-time reference navigation speed of the unmanned target ship;

[0039] The real-time navigation speed of the unmanned target ship is obtained, and the speed of the unmanned target ship is controlled according to the real-time benchmark navigation speed of the unmanned target ship and the real-time navigation speed of the unmanned target ship.

[0040] Furthermore, the speed control module performs speed control on the unmanned target ship as follows:

[0041] When the real-time navigation speed of the unmanned target ship is greater than the real-time reference navigation speed of the unmanned target ship, the speed of the unmanned target ship is controlled to be adjusted downward until the unmanned target ship is at the real-time reference navigation speed of the unmanned target ship;

[0042] When the real-time navigation speed of the unmanned target ship is less than the real-time reference navigation speed of the unmanned target ship, the speed of the unmanned target ship is controlled to be adjusted upward until the unmanned target ship is at the real-time reference navigation speed of the unmanned target ship.

[0043] Furthermore, the obstacle avoidance analysis module acquires obstacle analysis data as follows:

[0044] Obtain a real-time location mark map, and name multiple obstacles in the real-time location mark map as first to nth obstacles respectively;

[0045] Determine the state of obstacles and obtain obstacle motion judgment classification data;

[0046] The real-time moving speed of each moving obstacle is acquired respectively to obtain the real-time moving speed data of the moving obstacle;

[0047] The obstacle motion judgment classification data and the real-time moving speed data of the moving obstacle are defined as obstacle analysis data.

[0048] Furthermore, the obstacle avoidance analysis module obtains obstacle motion judgment classification data as follows:

[0049] Mark them as two coordinate time monitoring points in the real-time location mark map, and name them as the first coordinate time monitoring point and the second coordinate time monitoring point, respectively, and the time interval between the first coordinate time monitoring point and the second coordinate time monitoring point is a characteristic monitoring duration;

[0050] According to the real-time position mark map, the longitude and latitude coordinates of the first obstacle corresponding to the first coordinate time monitoring point and the second coordinate time monitoring point are obtained to obtain the first longitude and latitude coordinates and the second longitude and latitude coordinates. If the corresponding values ​​of the first longitude and latitude coordinates and the second longitude and latitude coordinates are the same, the first obstacle is judged to be a stationary obstacle. If the corresponding values ​​of the first longitude and latitude coordinates and the second longitude and latitude coordinates are different, the first obstacle is judged to be a moving obstacle.

[0051] The above process of judging the motion state of the first obstacle is repeated, and the motion state of each obstacle is judged respectively to obtain obstacle motion judgment classification data.

[0052] Furthermore, the obstacle avoidance analysis module acquires real-time moving speed data of moving obstacles, as follows:

[0053] If the first obstacle is a moving obstacle, the moving speed of the first obstacle is acquired to obtain the real-time moving speed of the first obstacle;

[0054] The target ship sea area plane rectangular coordinate system corresponding to the unmanned target ship at the second coordinate time monitoring point is used as the obstacle speed monitoring coordinate system;

[0055] Obtaining the plane rectangular coordinates of the first obstacle corresponding to the first coordinate time monitoring point and the second coordinate time monitoring point respectively through the obstacle speed monitoring coordinate system to obtain the first plane rectangular coordinate and the second plane rectangular coordinate;

[0056] Respectively obtain the abscissa value and the ordinate value of the first plane rectangular coordinate and the second plane rectangular coordinate in the obstacle speed monitoring coordinate system to obtain a first abscissa value, a first ordinate value, a second abscissa value, and a second ordinate value;

[0057] The real-time moving speed of the first obstacle is obtained by calculating the first horizontal coordinate value, the first vertical coordinate value, the second horizontal coordinate value, the second vertical coordinate value and the characteristic monitoring time corresponding to the first obstacle;

[0058] Repeat the process of acquiring the real-time moving speed of the first obstacle, and acquire the real-time moving speed of each moving obstacle respectively to obtain the real-time moving speed data of the moving obstacle;

[0059] The obstacle motion judgment classification data and the real-time moving speed data of the moving obstacle are defined as obstacle analysis data.

[0060] Furthermore, a database is included, and the data stored in the database also includes the latitude and longitude coordinates of the destination of the unmanned target ship;

[0061] The collision warning module performs collision warning control on the unmanned target ship, specifically as follows:

[0062] Obtain real-time location marking map and obstacle analysis data, and obtain obstacle motion judgment classification data based on the obstacle analysis data;

[0063] According to the obstacle motion judgment classification data, the stationary obstacles are marked as fixed obstacle points in the real-time position marking map;

[0064] Extracting the longitude and latitude coordinates of the destination of the unmanned target ship from the database, converting the longitude and latitude coordinates of the destination of the unmanned target ship into the plane rectangular coordinates of the destination of the unmanned target ship in the real-time position marking map, and marking them in the real-time position marking map;

[0065] Mark the map in real time at the location to generate the preliminary navigation path of the unmanned target ship using the shortest path generation algorithm based on the completed fixed obstacle points and the rectangular coordinates of the unmanned target ship's destination plane;

[0066] Mark the current moment as the first prediction time point on the real-time location map, and mark the feature prediction time period before the current moment as the second prediction time point;

[0067] If the first obstacle is a moving obstacle, performing collision warning control on the first obstacle;

[0068] The above process of performing collision warning control on the first obstacle is repeated, and collision warning control is performed on each obstacle respectively.

[0069] Further, the collision warning module performs collision warning control on the first obstacle, specifically as follows:

[0070] Obtain the plane rectangular coordinates of the first obstacle at the first predicted time point and the second predicted time point respectively through the real-time position mark map, obtain the first predicted coordinate point and the second predicted coordinate point, take the first predicted coordinate point as the ray endpoint, make a motion ray corresponding to the first obstacle through the second predicted coordinate point, and obtain the first obstacle motion ray;

[0071] Obtain the intersection of the first obstacle motion ray and the preliminary navigation path of the unmanned target ship to obtain a third predicted coordinate point, calculate the distance between the second predicted coordinate point and the third predicted coordinate point by using the rectangular coordinates corresponding to the second predicted coordinate point and the third predicted coordinate point, and obtain the predicted movement distance of the first obstacle;

[0072] Obtaining real-time moving speed data of the moving obstacle through the obstacle analysis data, obtaining the real-time moving speed of the first obstacle according to the real-time moving speed data of the moving obstacle, and calculating the remaining time for the first obstacle to reach the third predicted coordinate point through the predicted moving distance of the first obstacle and the real-time moving speed of the first obstacle, thereby obtaining the first predicted remaining time;

[0073] Obtain the path length value between the current position of the unmanned target ship and the third predicted coordinate point through the real-time position mark map, obtain the real-time reference navigation speed of the unmanned target ship, calculate the remaining time for the unmanned target ship to reach the third predicted coordinate point by combining the path length value and the real-time reference navigation speed of the unmanned target ship, and name it as the second predicted remaining time;

[0074] If the first predicted remaining time is equal to the second predicted remaining time, the unmanned target ship issues a collision warning and adjusts the real-time reference navigation speed of the unmanned target ship downward.

[0075] In summary, due to the adoption of the above technical solution, the beneficial effects of the present invention are:

[0076] 1. The present invention obtains the obstacle density value, the real-time wave height difference and the real-time horizontal deviation angle of the unmanned target ship to calculate the real-time reference navigation speed of the unmanned target ship to control the navigation speed of the unmanned target ship in real time, which can effectively avoid the problems of low control efficiency and insufficient safety caused by manual control of the speed of the unmanned target ship;

[0077] 2. The present invention automatically performs collision warning control on the unmanned target ship according to the real-time position marking map, the real-time benchmark navigation speed of the unmanned target ship and the obstacle analysis data, can quickly detect the potential collision risk and take immediate measures to avoid it, effectively reducing the probability of collision and improving the working safety of the unmanned target ship. BRIEF DESCRIPTION OF THE DRAWINGS

[0078] In order to facilitate understanding by those skilled in the art, the present invention is further described below with reference to the accompanying drawings.

[0079] Figure 1 is the overall system block diagram of the present invention;

[0080] Figure 2 It is a diagram of the implementation steps of the present invention;

[0081] Figure 3 This is a schematic diagram of a rectangular coordinate system for marking a target ship sea area in the present invention;

[0082] Figure 4 It is a schematic diagram of collision prediction in the present invention. DETAILED DESCRIPTION

[0083] The technical solution of the present invention will be clearly and completely described below in conjunction with the embodiments. Obviously, the described embodiments are only part of the embodiments of the present invention, rather than all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0084] Embodiment 1

[0085] See also Figure 1 , the present invention provides a technical solution: an unmanned target ship control system based on position data, comprising a position acquisition module, a speed control module, an obstacle avoidance analysis module, a collision warning module and a server, wherein the position acquisition module, the speed control module, the obstacle avoidance analysis module and the collision warning module are respectively connected to the server;

[0086] The location acquisition module acquires the location and marks the map in real time;

[0087] Also included is a database, wherein the data stored in the database includes a geographic information map of the target ship's navigation area;

[0088] Extracting the target ship navigation sea area geographic information map and the preset detection distance from the database, the unmanned target ship acquires its own latitude and longitude coordinates through the first data acquisition device, and marks them on the target ship navigation sea area geographic information map to obtain the target ship coordinate marking point;

[0089] In the target ship navigation sea area geographic information map, the target ship coordinate mark point is used as the coordinate origin. In the target ship navigation sea area geographic information map, a straight line running east-west through the coordinate origin is marked as the coordinate X axis, and a straight line running north-south through the coordinate origin is marked as the coordinate Y axis. The plane rectangular coordinate system composed of the coordinate origin, the coordinate X axis and the coordinate Y axis is marked as the target ship sea area plane rectangular coordinate system;

[0090] Extract the preset detection distance from the database, take the target ship coordinate mark point as the center of the circle, and the preset detection distance as the radius, mark the detection distance mark circle in the plane rectangular coordinate system of the target ship sea area, and obtain the target ship environment detection area;

[0091] It should be noted here that:

[0092] In this application, the preset detection distance is specifically set to three kilometers;

[0093] Obstacle detection is performed in the target ship environment detection area, as follows:

[0094] Obtain the real-time draft depth of the unmanned target ship and obtain the reference depth value for underwater object detection;

[0095] dividing the target ship environment detection area into a first type detection area and a second type detection area;

[0096] For the first type of detection area, the unmanned target ship uses the second data acquisition device to obtain the depth of the subsurface objects in the target ship environment detection area from the water surface, obtains multiple depth values ​​of the objects from the water surface, and compares the multiple depth values ​​of the objects from the water surface with the underwater object detection reference depth values. When the object depth value from the water surface is less than the underwater object detection reference depth value, it is judged that the underwater object is a first type of obstacle, and the real-time longitude and latitude coordinates of the multiple first type obstacles are respectively obtained to obtain the longitude and latitude coordinates of the multiple obstacles;

[0097] For the second type of detection area, the unmanned target ship detects objects above the water surface in the target ship environment detection area through the third data acquisition device, marks the objects above the water surface as second type of obstacles, and acquires the longitude and latitude coordinates of multiple second type obstacles in real time to obtain the longitude and latitude coordinates of multiple obstacles;

[0098] It should be noted here that:

[0099] In this application, objects below the water surface include but are not limited to rocks, submarine reefs and shipwrecks, and objects above the water surface include but are not limited to ships, lighthouses and islands;

[0100] The longitude and latitude coordinates corresponding to the multiple obstacles are marked on the target ship navigation area geographic information map, and are converted into plane rectangular coordinates through the target ship sea area plane rectangular coordinate system to obtain the plane rectangular coordinates corresponding to each obstacle;

[0101] The plane rectangular coordinates corresponding to each obstacle are synchronized in the plane rectangular coordinate system of the target ship sea area;

[0102] See also Figure 3 , positioning the target ship navigation sea area geographic information map marking the target ship sea area plane rectangular coordinate system, the target ship environment detection area, the preset detection distance and the plane rectangular coordinates corresponding to each obstacle as a real-time position marking map;

[0103] It should be noted here that:

[0104] In the present application, the first data acquisition device is a position sensor, the second data acquisition device is a sonar detector, and the third data acquisition device is a radar detector;

[0105] The position acquisition module acquires the real-time position mark map and transmits it to the speed control module and the obstacle avoidance analysis module;

[0106] The speed control module obtains the real-time reference navigation speed of the unmanned target ship according to the real-time position mark map, and controls the navigation speed of the unmanned target ship;

[0107] Obtain the obstacle density value as follows:

[0108] Obtaining a real-time marked map of the location, and obtaining the quantity of the first type of obstacles and the second type of obstacles according to the real-time marked map of the location, to obtain the quantity value of the first type of obstacles and the quantity value of the second type of obstacles;

[0109] The preset detection distance is obtained through the real-time location mark map, and the preset detection distance, the number of first-type obstacles and the number of second-type obstacles are calculated to obtain the obstacle density value corresponding to the target ship environment detection area;

[0110] Calculate the obstacle density value corresponding to the target ship environment detection area. The specific formula configuration is as follows:

[0111] ;

[0112] Wherein, Zam is the obstacle density value corresponding to the target ship environment detection area, Zws1 is the number of obstacles of the first type, Zws2 is the number of obstacles of the second type, and Ytj is the preset detection distance;

[0113] Place a height monitoring float in the sea area around the unmanned target ship, obtain the wave fluctuation cycle closest to the current time as the real-time wave fluctuation cycle, obtain the maximum height value and the minimum height value corresponding to the height monitoring float in the real-time wave fluctuation cycle, calculate the difference between the maximum height value and the minimum height value, and obtain the real-time wave fluctuation height difference;

[0114] Get the horizontal deviation angle of the unmanned target ship, as follows:

[0115] Taking the current time point as the reference time point, randomly mark m / 2 horizontal monitoring time points with the same time interval before the reference time, and randomly mark m / 2 horizontal monitoring time points with the same time interval after the reference time, to obtain m horizontal monitoring time points, which are named the first to the mth horizontal monitoring time points respectively;

[0116] It should be noted here that:

[0117] Here, m is the number of horizontal monitoring time points, and m is a positive integer;

[0118] The horizontal tilt angle values ​​corresponding to the first to mth horizontal monitoring time points are respectively acquired by the fourth data acquisition device to obtain the first to mth horizontal tilt angle values, and the first to mth horizontal tilt angle values ​​are averaged to obtain the horizontal real-time deviation angle of the unmanned target ship;

[0119] Obtain the baseline navigation speed of the unmanned target ship;

[0120] It should be noted here that:

[0121] The reference navigation speed of the unmanned target ship involved here is the maximum navigation speed of the unmanned target ship;

[0122] The real-time reference navigation speed of the unmanned target ship is calculated by the reference navigation speed of the unmanned target ship, the obstacle density value, the real-time wave height difference and the real-time horizontal deviation angle of the unmanned target ship to obtain the real-time reference navigation speed of the unmanned target ship;

[0123] The real-time reference navigation speed of the unmanned target ship is calculated, and the specific formula configuration is as follows:

[0124] ;

[0125] Among them, Sjh is the real-time reference navigation speed of the unmanned target ship, Zam is the obstacle density value, Qfc is the real-time wave height difference, Spj is the real-time horizontal deviation angle of the unmanned target ship, and a1 is the set proportional coefficient and a1 is greater than 0;

[0126] Get the real-time speed of the unmanned target ship;

[0127] When the real-time navigation speed of the unmanned target ship is greater than the real-time reference navigation speed of the unmanned target ship, the speed of the unmanned target ship is controlled to be adjusted downward until the unmanned target ship is at the real-time reference navigation speed of the unmanned target ship;

[0128] When the real-time navigation speed of the unmanned target ship is less than the real-time reference navigation speed of the unmanned target ship, the speed of the unmanned target ship is controlled to be adjusted upward until the unmanned target ship is at the real-time reference navigation speed of the unmanned target ship;

[0129] The speed control module obtains the real-time reference navigation speed of the unmanned target ship and transmits it to the collision warning module;

[0130] The obstacle avoidance analysis module performs obstacle analysis on the unmanned target ship based on the real-time position marking map to obtain obstacle analysis data;

[0131] Obtain a real-time location mark map, and name multiple obstacles in the real-time location mark map as first to nth obstacles respectively;

[0132] Determine the state of obstacles and obtain obstacle motion judgment classification data;

[0133] Mark them as two coordinate time monitoring points in the real-time location mark map, and name them as the first coordinate time monitoring point and the second coordinate time monitoring point, respectively, and the time interval between the first coordinate time monitoring point and the second coordinate time monitoring point is a characteristic monitoring duration;

[0134] It should be noted here that:

[0135] In this application, the second coordinate time monitoring point is the current moment, the first coordinate time monitoring point is the feature monitoring duration before the current moment, and the specific duration value corresponding to the feature monitoring duration is 3 seconds;

[0136] According to the real-time position mark map, the longitude and latitude coordinates of the first obstacle corresponding to the first coordinate time monitoring point and the second coordinate time monitoring point are obtained to obtain the first longitude and latitude coordinates and the second longitude and latitude coordinates. If the corresponding values ​​of the first longitude and latitude coordinates and the second longitude and latitude coordinates are the same, the first obstacle is judged to be a stationary obstacle. If the corresponding values ​​of the first longitude and latitude coordinates and the second longitude and latitude coordinates are different, the first obstacle is judged to be a moving obstacle.

[0137] Repeat the above process of judging the motion state of the first obstacle, and judge the motion state of each obstacle respectively to obtain obstacle motion judgment classification data;

[0138] The real-time moving speed of each moving obstacle is acquired respectively to obtain the real-time moving speed data of the moving obstacle;

[0139] If the first obstacle is a moving obstacle, the moving speed of the first obstacle is acquired to obtain the real-time moving speed of the first obstacle;

[0140] The target ship sea area plane rectangular coordinate system corresponding to the unmanned target ship at the second coordinate time monitoring point is used as the obstacle speed monitoring coordinate system;

[0141] Obtaining the plane rectangular coordinates of the first obstacle corresponding to the first coordinate time monitoring point and the second coordinate time monitoring point respectively through the obstacle speed monitoring coordinate system to obtain the first plane rectangular coordinate and the second plane rectangular coordinate;

[0142] Respectively obtain the abscissa value and the ordinate value of the first plane rectangular coordinate and the second plane rectangular coordinate in the obstacle speed monitoring coordinate system to obtain a first abscissa value, a first ordinate value, a second abscissa value, and a second ordinate value;

[0143] The real-time moving speed of the first obstacle is obtained by calculating the first horizontal coordinate value, the first vertical coordinate value, the second horizontal coordinate value, the second vertical coordinate value and the characteristic monitoring time corresponding to the first obstacle;

[0144] Calculate the real-time moving speed of the first obstacle. The specific formula is as follows:

[0145] ;

[0146] Wherein, Vzy1 is the real-time moving speed of the first obstacle, Y1 is the first ordinate value, Y2 is the second ordinate value, X1 is the first abscissa, X2 is the second abscissa, and Tsc is the feature monitoring duration;

[0147] Repeat the process of acquiring the real-time moving speed of the first obstacle, and acquire the real-time moving speed of each moving obstacle respectively to obtain the real-time moving speed data of the moving obstacle;

[0148] The obstacle motion judgment classification data and the real-time moving speed data of the moving obstacles are defined as obstacle analysis data;

[0149] The collision warning module performs collision warning control on the unmanned target ship based on the real-time location mark map, the real-time reference navigation speed of the unmanned target ship, and obstacle analysis data;

[0150] Also included is a database, wherein the data stored in the database also includes the latitude and longitude coordinates of the destination of the unmanned target ship;

[0151] Obtain real-time location marking map and obstacle analysis data, and obtain obstacle motion judgment classification data based on the obstacle analysis data;

[0152] According to the obstacle motion judgment classification data, the stationary obstacles are marked as fixed obstacle points in the real-time position marking map;

[0153] Extracting the longitude and latitude coordinates of the destination of the unmanned target ship from the database, converting the longitude and latitude coordinates of the destination of the unmanned target ship into the plane rectangular coordinates of the destination of the unmanned target ship in the real-time position marking map, and marking them in the real-time position marking map;

[0154] Mark the map in real time at the location to generate the preliminary navigation path of the unmanned target ship using the shortest path generation algorithm based on the completed fixed obstacle points and the rectangular coordinates of the unmanned target ship's destination plane;

[0155] It should be noted here that: in the present application, the shortest path generation algorithm involved may be the Dijkstra algorithm, and the initial navigation path of the unmanned target ship generated here is the shortest navigation path of the unmanned target ship to the destination of the unmanned target ship under the premise of avoiding fixed obstacle points;

[0156] Mark the current moment as the first prediction time point on the real-time location map, and mark the feature prediction time period before the current moment as the second prediction time point;

[0157] If the first obstacle is a moving obstacle, performing collision warning control on the first obstacle;

[0158] The details are as follows:

[0159] See also Figure 4 , obtaining the plane rectangular coordinates of the first obstacle at the first prediction time point and the second prediction time point respectively through the real-time position mark map, obtaining the first prediction coordinate point and the second prediction coordinate point, taking the first prediction coordinate point as the ray endpoint, making a motion ray corresponding to the first obstacle through the second prediction coordinate point, and obtaining the first obstacle motion ray;

[0160] Obtain the intersection of the first obstacle motion ray and the preliminary navigation path of the unmanned target ship to obtain a third predicted coordinate point, calculate the distance between the second predicted coordinate point and the third predicted coordinate point by using the rectangular coordinates corresponding to the second predicted coordinate point and the third predicted coordinate point, and obtain the predicted movement distance of the first obstacle;

[0161] Obtaining real-time moving speed data of the moving obstacle through the obstacle analysis data, obtaining the real-time moving speed of the first obstacle according to the real-time moving speed data of the moving obstacle, and calculating the remaining time for the first obstacle to reach the third predicted coordinate point through the predicted moving distance of the first obstacle and the real-time moving speed of the first obstacle, thereby obtaining the first predicted remaining time;

[0162] Obtain the path length value between the current position of the unmanned target ship and the third predicted coordinate point through the real-time position mark map, obtain the real-time reference navigation speed of the unmanned target ship, calculate the remaining time for the unmanned target ship to reach the third predicted coordinate point by combining the path length value and the real-time reference navigation speed of the unmanned target ship, and name it as the second predicted remaining time;

[0163] If the first predicted remaining time is equal to the second predicted remaining time, the unmanned target ship issues a collision warning and adjusts the real-time reference navigation speed of the unmanned target ship downward;

[0164] Repeat the above process of performing collision warning control on the first obstacle, and perform collision warning control on each obstacle respectively;

[0165] In this application, if corresponding calculation formulas appear, the above calculation formulas are all dimensionless and take their numerical calculations. The weight coefficients, proportional coefficients and other coefficients in the formulas are set to a result value obtained by quantifying each parameter. The size of the weight coefficient and the proportional coefficient can be determined as long as it does not affect the proportional relationship between the parameter and the result value.

[0166] Embodiment 2

[0167] See also Figure 2 Based on another concept of the same invention, a method for controlling an unmanned target ship based on position data is now proposed, comprising the following steps:

[0168] Step S1: Obtaining a real-time location marking map;

[0169] Also included is a database, wherein the data stored in the database includes a geographic information map of the target ship's navigation area;

[0170] Step S11: extracting the target ship's navigation area geographic information map and the preset detection distance from the database, the unmanned target ship acquires its own latitude and longitude coordinates through the first data acquisition device, and marks it on the target ship's navigation area geographic information map to obtain the target ship coordinate marking point;

[0171] Step S12: In the target ship navigation sea area geographic information map, the target ship coordinate mark point is used as the coordinate origin. In the target ship navigation sea area geographic information map, a straight line running east-west through the coordinate origin is made, which is marked as the coordinate X axis, and a straight line running north-south through the coordinate origin is made, which is marked as the coordinate Y axis. The plane rectangular coordinate system composed of the coordinate origin, the coordinate X axis and the coordinate Y axis is marked as the target ship sea area plane rectangular coordinate system;

[0172] Step S13: extracting the preset detection distance from the database, taking the target ship coordinate mark point as the center of the circle and the preset detection distance as the radius, marking the detection distance mark circle in the target ship sea area plane rectangular coordinate system, and obtaining the target ship environment detection area;

[0173] Step S14: performing obstacle detection on the target ship environment detection area;

[0174] The specific steps are as follows:

[0175] Step S141: obtaining the real-time draft depth of the unmanned target ship and obtaining a reference depth value for underwater object detection;

[0176] Step S142: dividing the target ship environment detection area into a first type detection area and a second type detection area;

[0177] Step S143: For the first type of detection area, the unmanned target ship obtains the depth of the objects below the water surface in the target ship environment detection area through the second data acquisition device, obtains multiple depth values ​​of the objects from the water surface, and compares the multiple depth values ​​of the objects from the water surface with the underwater object detection reference depth values. When the depth value of the object from the water surface is less than the underwater object detection reference depth value, it is determined that the underwater object is a first type of obstacle, and the real-time longitude and latitude coordinates of the multiple first type obstacles are respectively obtained to obtain the longitude and latitude coordinates of the multiple obstacles;

[0178] Step S144: for the second type detection area, the unmanned target ship detects objects above the water surface in the target ship environment detection area through the third data acquisition device, marks the objects above the water surface as second type obstacles, and acquires the longitude and latitude coordinates of multiple second type obstacles in real time to obtain the longitude and latitude coordinates of multiple obstacles;

[0179] Step S15: Mark the longitude and latitude coordinates corresponding to the multiple obstacles on the target ship navigation area geographic information map, and convert them into plane rectangular coordinates through the target ship sea area plane rectangular coordinate system to obtain the plane rectangular coordinates corresponding to each obstacle;

[0180] Step S16: synchronizing the position of the plane rectangular coordinates corresponding to each obstacle in the plane rectangular coordinate system of the target ship sea area;

[0181] Step S17: positioning the target ship navigation sea area geographic information map marking the target ship sea area plane rectangular coordinate system, the target ship environment detection area, the preset detection distance and the plane rectangular coordinates corresponding to each obstacle as a real-time position marking map;

[0182] Step S2: obtaining the real-time reference navigation speed of the unmanned target ship according to the real-time position mark map, and controlling the navigation speed of the unmanned target ship;

[0183] Step S21: Obtain obstacle density value;

[0184] The specific steps are as follows:

[0185] Step S211: obtaining a real-time location mark map, and obtaining the number of first-type obstacles and second-type obstacles according to the real-time location mark map to obtain the number value of the first-type obstacles and the number value of the second-type obstacles;

[0186] Step S212: obtaining a preset detection distance through the real-time position mark map, and calculating the preset detection distance, the number of first-type obstacles and the number of second-type obstacles to obtain an obstacle density value corresponding to the target ship environment detection area;

[0187] Step S213: placing a height monitoring float in the sea area around the unmanned target ship, obtaining the wave fluctuation cycle closest to the current time as the real-time wave fluctuation cycle, respectively obtaining the maximum height value and the minimum height value corresponding to the height monitoring float in the real-time wave fluctuation cycle, calculating the difference between the maximum height value and the minimum height value, and obtaining the real-time wave fluctuation height difference;

[0188] Step S22: obtaining the horizontal deviation angle of the unmanned target ship;

[0189] The specific steps are as follows:

[0190] Step S221: taking the current time point as the reference time point, randomly marking m / 2 horizontal monitoring time points with the same time interval before the reference time, and randomly marking m / 2 horizontal monitoring time points with the same time interval after the reference time, to obtain m horizontal monitoring time points, which are named as the first to the mth horizontal monitoring time points respectively;

[0191] Step S222: acquiring the horizontal tilt angle values ​​corresponding to the first to m-th horizontal monitoring time points respectively through the fourth data acquisition device to obtain the first to m-th horizontal tilt angle values, and averaging the first to m-th horizontal tilt angle values ​​to obtain the horizontal real-time deviation angle of the unmanned target ship;

[0192] Step S23: obtaining the reference navigation speed of the unmanned target ship;

[0193] Step S24: Calculate the unmanned target ship's real-time reference navigation speed by using the unmanned target ship's reference navigation speed, the obstacle density value, the real-time wave height difference, and the unmanned target ship's real-time horizontal deviation angle;

[0194] Step S25: obtaining the real-time navigation speed of the unmanned target ship, and controlling the speed of the unmanned target ship according to the real-time reference navigation speed of the unmanned target ship and the real-time navigation speed of the unmanned target ship;

[0195] The specific steps are as follows:

[0196] Step S251: when the real-time navigation speed of the unmanned target ship is greater than the real-time reference navigation speed of the unmanned target ship, the speed of the unmanned target ship is controlled to be adjusted downward until the unmanned target ship is at the real-time reference navigation speed of the unmanned target ship;

[0197] Step S252: when the real-time navigation speed of the unmanned target ship is less than the real-time reference navigation speed of the unmanned target ship, the speed of the unmanned target ship is controlled to be adjusted upward until the unmanned target ship is at the real-time reference navigation speed of the unmanned target ship;

[0198] Step S3: performing obstacle analysis on the unmanned target ship according to the real-time position marking map to obtain obstacle analysis data;

[0199] Step S31: obtaining a real-time location mark map, and naming a plurality of obstacles in the real-time location mark map as first to nth obstacles respectively;

[0200] Step S32: judging the state of the obstacle to obtain obstacle motion judgment classification data;

[0201] The specific steps are as follows:

[0202] Step S321: Mark two coordinate time monitoring points in the real-time location mark map, and name them as the first coordinate time monitoring point and the second coordinate time monitoring point, respectively, and the time interval between the first coordinate time monitoring point and the second coordinate time monitoring point is a characteristic monitoring duration;

[0203] Step S322: acquiring the longitude and latitude coordinates of the first obstacle corresponding to the first coordinate time monitoring point and the second coordinate time monitoring point respectively according to the real-time position mark map, and obtaining the first longitude and latitude coordinates and the second longitude and latitude coordinates. If the corresponding values ​​of the first longitude and latitude coordinates and the second longitude and latitude coordinates are the same, the first obstacle is judged to be a stationary obstacle. If the corresponding values ​​of the first longitude and latitude coordinates and the second longitude and latitude coordinates are different, the first obstacle is judged to be a moving obstacle.

[0204] Step S323: repeat the above process of judging the motion state of the first obstacle, and judge the motion state of each obstacle respectively to obtain obstacle motion judgment classification data;

[0205] Step S33: acquiring the real-time moving speed of each moving obstacle respectively to obtain the real-time moving speed data of the moving obstacle;

[0206] The details are as follows:

[0207] Step S331: if the first obstacle is a moving obstacle, obtain the moving speed of the first obstacle to obtain the real-time moving speed of the first obstacle;

[0208] Step S332: taking the target ship sea area plane rectangular coordinate system corresponding to the unmanned target ship at the second coordinate time monitoring point as the obstacle speed monitoring coordinate system;

[0209] Step S333: Obtaining the plane rectangular coordinates of the first obstacle corresponding to the first coordinate time monitoring point and the second coordinate time monitoring point respectively through the obstacle speed monitoring coordinate system to obtain the first plane rectangular coordinate and the second plane rectangular coordinate;

[0210] Step S334: respectively obtaining the abscissa value and the ordinate value of the first plane rectangular coordinate and the second plane rectangular coordinate in the obstacle speed monitoring coordinate system to obtain a first abscissa value, a first ordinate value, a second abscissa value, and a second ordinate value;

[0211] Step S335: Calculate the first horizontal coordinate value, the first vertical coordinate value, the second horizontal coordinate value, the second vertical coordinate value and the characteristic monitoring time corresponding to the first obstacle to obtain the real-time moving speed of the first obstacle;

[0212] Step S336: Repeat the process of acquiring the real-time moving speed of the first obstacle, and acquire the real-time moving speed of each moving obstacle respectively to obtain the real-time moving speed data of the moving obstacle;

[0213] Step S34: defining the obstacle motion judgment classification data and the moving obstacle real-time moving speed data as obstacle analysis data;

[0214] Step S4: performing collision warning control on the unmanned target ship according to the real-time position mark map, the real-time reference navigation speed of the unmanned target ship and the obstacle analysis data;

[0215] Also included is a database, wherein the data stored in the database also includes the latitude and longitude coordinates of the destination of the unmanned target ship;

[0216] Step S41: obtaining a real-time location marking map and obstacle analysis data, and obtaining obstacle motion judgment classification data according to the obstacle analysis data;

[0217] Step S42: Marking the stationary obstacle as a fixed obstacle point in the real-time position marking map according to the obstacle motion judgment classification data;

[0218] Step S43: extracting the longitude and latitude coordinates of the destination of the unmanned target ship from the database, converting the longitude and latitude coordinates of the destination of the unmanned target ship into the plane rectangular coordinates of the destination of the unmanned target ship in the real-time position marking map, and marking them in the real-time position marking map;

[0219] Step S44: Generate a preliminary navigation path for the unmanned target ship on the real-time location marking map using the shortest path generation algorithm based on the completed fixed obstacle points and the rectangular coordinates of the unmanned target ship's destination plane;

[0220] Step S45: marking the current moment as the first prediction time point on the real-time location map, and marking the feature prediction time period before the current moment as the second prediction time point;

[0221] Step S46: If the first obstacle is a moving obstacle, collision warning control is performed on the first obstacle;

[0222] The specific steps are as follows:

[0223] Step S461: Obtain the plane rectangular coordinates of the first obstacle at the first prediction time point and the second prediction time point respectively through the real-time position mark map, obtain the first prediction coordinate point and the second prediction coordinate point, take the first prediction coordinate point as the ray endpoint, make a motion ray corresponding to the first obstacle through the second prediction coordinate point, and obtain the first obstacle motion ray;

[0224] Step S462: Obtain the intersection of the first obstacle motion ray and the preliminary navigation path of the unmanned target ship to obtain a third predicted coordinate point, calculate the distance between the second predicted coordinate point and the third predicted coordinate point through the rectangular coordinates corresponding to the second predicted coordinate point and the third predicted coordinate point, and obtain the predicted movement distance of the first obstacle;

[0225] Step S463: obtaining real-time moving speed data of the moving obstacle through the obstacle analysis data, obtaining the real-time moving speed of the first obstacle according to the real-time moving speed data of the moving obstacle, and calculating the remaining time for the first obstacle to reach the third predicted coordinate point through the predicted moving distance of the first obstacle and the real-time moving speed of the first obstacle, thereby obtaining the first predicted remaining time;

[0226] Step S464: obtaining the path length value between the current position of the unmanned target ship and the third predicted coordinate point through the real-time position mark map, obtaining the real-time reference navigation speed of the unmanned target ship, calculating the remaining time for the unmanned target ship to reach the third predicted coordinate point by combining the path length value and the real-time reference navigation speed of the unmanned target ship, and naming it as the second predicted remaining time;

[0227] Step S465: If the first predicted remaining time is equal to the second predicted remaining time, the unmanned target ship issues a collision warning and adjusts the real-time reference navigation speed of the unmanned target ship downward;

[0228] Step S47: Repeat the above process of performing collision warning control on the first obstacle, and perform collision warning control on each obstacle respectively.

[0229] The preferred embodiments of the present invention disclosed above are only used to help explain the present invention. The preferred embodiments do not describe all the details in detail, nor do they limit the invention to only specific implementation methods. Obviously, many modifications and changes can be made according to the content of this specification. This specification selects and specifically describes these embodiments in order to better explain the principles and practical applications of the present invention, so that those skilled in the art can understand and use the present invention well. The present invention is limited only by the claims and their full scope and equivalents.

Claims

1. An unmanned target ship control system based on position data, characterized in that: include: Position acquisition module: used to obtain the plane rectangular coordinate system of the target ship sea area, the target ship environment detection area, the preset detection distance and the plane rectangular coordinates corresponding to each obstacle, mark the geographic information map of the target ship's navigation area, and obtain a real-time marked map of the position; Speed ​​control module: used to calculate the real-time reference speed of the unmanned target ship according to the real-time position mark map, and control the real-time speed of the unmanned target ship; Obstacle avoidance analysis module: used to obtain obstacle motion judgment classification data and real-time moving speed data of moving obstacles to obtain obstacle analysis data; Collision warning module: used to perform collision warning control on the unmanned target ship based on the real-time location marking map, the real-time reference navigation speed of the unmanned target ship, and obstacle analysis data; Get the real-time location mark map as follows: Obtaining a geographic information map of the target ship's navigation area and a preset detection distance, the unmanned target ship obtains its own latitude and longitude coordinates through a first data acquisition device, and marks them on the geographic information map of the target ship's navigation area to obtain a target ship coordinate marking point; In the target ship navigation sea area geographic information map, the target ship coordinate mark point is used as the coordinate origin. In the target ship navigation sea area geographic information map, a straight line running east-west through the coordinate origin is marked as the coordinate X axis, and a straight line running north-south through the coordinate origin is marked as the coordinate Y axis. The plane rectangular coordinate system composed of the coordinate origin, the coordinate X axis and the coordinate Y axis is marked as the target ship sea area plane rectangular coordinate system; With the target ship coordinate mark point as the center and the preset detection distance as the radius, mark the detection distance mark circle in the plane rectangular coordinate system of the target ship sea area to obtain the target ship environment detection area; Conduct obstacle detection in the target ship environment detection area and obtain the longitude and latitude coordinates of multiple obstacles; The longitude and latitude coordinates of multiple obstacles are marked on the target ship navigation area geographic information map, and are converted into plane rectangular coordinates through the target ship sea area plane rectangular coordinate system to obtain the plane rectangular coordinates corresponding to each obstacle; The plane rectangular coordinates corresponding to each obstacle are synchronized in the plane rectangular coordinate system of the target ship sea area; The target ship navigation sea area geographic information map marking the target ship sea area plane rectangular coordinate system, the target ship environment detection area, the preset detection distance and the plane rectangular coordinates corresponding to each obstacle is positioned as a real-time position marking map, the real-time benchmark navigation speed of the unmanned target ship is obtained according to the real-time position marking map, and the first type of obstacles and the second type of obstacles are determined according to the target ship environment detection area; The real-time reference navigation speed of the unmanned target ship is obtained as follows: Get obstacle density value; Obtaining a real-time marked map of the location, and obtaining the quantity of the first type of obstacles and the second type of obstacles according to the real-time marked map of the location, to obtain the quantity value of the first type of obstacles and the quantity value of the second type of obstacles; The preset detection distance is obtained through the real-time location mark map, and the preset detection distance, the number of first-type obstacles and the number of second-type obstacles are calculated to obtain the obstacle density value corresponding to the target ship environment detection area; Place a height monitoring float in the sea area around the unmanned target ship, obtain the wave fluctuation cycle closest to the current time as the real-time wave fluctuation cycle, obtain the maximum height value and the minimum height value corresponding to the height monitoring float in the real-time wave fluctuation cycle, calculate the difference between the maximum height value and the minimum height value, and obtain the real-time wave fluctuation height difference; Obtain the horizontal deviation angle of the unmanned target ship; Taking the current time point as the reference time point, randomly mark m / 2 horizontal monitoring time points with the same time interval before the reference time, and randomly mark m / 2 horizontal monitoring time points with the same time interval after the reference time, to obtain m horizontal monitoring time points, which are named the first to the mth horizontal monitoring time points respectively; The horizontal tilt angle values ​​corresponding to the first to mth horizontal monitoring time points are respectively obtained to obtain the first to mth horizontal tilt angle values, and the first to mth horizontal tilt angle values ​​are averaged to obtain the horizontal real-time deviation angle of the unmanned target ship; Obtain the baseline navigation speed of the unmanned target ship; The real-time reference navigation speed of the unmanned target ship is calculated by the reference navigation speed of the unmanned target ship, the obstacle density value, the real-time wave height difference and the real-time horizontal deviation angle of the unmanned target ship to obtain the real-time reference navigation speed of the unmanned target ship; The real-time reference navigation speed of the unmanned target ship is calculated, and the specific formula configuration is as follows: ; Among them, Sjh is the real-time reference navigation speed of the unmanned target ship, Zam is the obstacle density value, Qfc is the real-time wave height difference, Spj is the real-time horizontal deviation angle of the unmanned target ship, and a1 is the set proportional coefficient and a1 is greater than 0; The speed of the unmanned target ship is controlled as follows: Get the real-time speed of the unmanned target ship; When the real-time navigation speed of the unmanned target ship is greater than the real-time reference navigation speed of the unmanned target ship, the speed of the unmanned target ship is controlled to be adjusted downward until the unmanned target ship is at the real-time reference navigation speed of the unmanned target ship; When the real-time navigation speed of the unmanned target ship is less than the real-time reference navigation speed of the unmanned target ship, the speed of the unmanned target ship is controlled to be adjusted upward until the unmanned target ship is at the real-time reference navigation speed of the unmanned target ship; The collision warning module performs collision warning control on the unmanned target ship, specifically as follows: Obtaining a real-time location marking map and obstacle analysis data, obtaining obstacle motion judgment classification data according to the obstacle analysis data, and marking the first obstacle to the nth obstacle respectively according to the real-time location marking map; According to the obstacle motion judgment classification data, the stationary obstacles are marked as fixed obstacle points in the real-time position marking map; Obtain the longitude and latitude coordinates of the destination of the unmanned target ship, convert the longitude and latitude coordinates of the destination of the unmanned target ship into the plane rectangular coordinates of the destination of the unmanned target ship in the real-time mark map, and mark them in the real-time mark map; Mark the map in real time at the location, and generate the preliminary navigation path of the unmanned target ship using the shortest path generation algorithm based on the completed fixed obstacle points and the plane rectangular coordinates of the unmanned target ship's destination; Mark the current moment as the first prediction time point on the real-time location map, and mark the feature prediction time period before the current moment as the second prediction time point; If the first obstacle is a moving obstacle, performing collision warning control on the first obstacle; Repeat the above process of performing collision warning control on the first obstacle, and perform collision warning control on each obstacle respectively; The collision warning module performs collision warning control on the first obstacle, specifically as follows: Obtain the plane rectangular coordinates of the first obstacle at the first predicted time point and the second predicted time point respectively through the real-time position mark map, obtain the first predicted coordinate point and the second predicted coordinate point, take the first predicted coordinate point as the ray endpoint, make a motion ray corresponding to the first obstacle through the second predicted coordinate point, and obtain the first obstacle motion ray; Obtain the intersection of the first obstacle motion ray and the preliminary navigation path of the unmanned target ship to obtain a third predicted coordinate point, calculate the distance between the second predicted coordinate point and the third predicted coordinate point by using the rectangular coordinates corresponding to the second predicted coordinate point and the third predicted coordinate point, and obtain the predicted movement distance of the first obstacle; Obtaining real-time moving speed data of the moving obstacle through the obstacle analysis data, obtaining the real-time moving speed of the first obstacle according to the real-time moving speed data of the moving obstacle, and calculating the remaining time for the first obstacle to reach the third predicted coordinate point through the predicted moving distance of the first obstacle and the real-time moving speed of the first obstacle, thereby obtaining the first predicted remaining time; Obtain the path length value between the current position of the unmanned target ship and the third predicted coordinate point through the real-time position mark map, obtain the real-time reference navigation speed of the unmanned target ship, calculate the remaining time for the unmanned target ship to reach the third predicted coordinate point by combining the path length value and the real-time reference navigation speed of the unmanned target ship, and name it as the second predicted remaining time; If the first predicted remaining time is equal to the second predicted remaining time, the unmanned target ship issues a collision warning and adjusts the real-time reference navigation speed of the unmanned target ship downward.

2. The unmanned target ship control system based on position data according to claim 1 is characterized in that: The latitude and longitude coordinates of multiple obstacles are obtained as follows: Obtain the real-time draft depth of the unmanned target ship and obtain the reference depth value for underwater object detection; dividing the target ship environment detection area into a first type detection area and a second type detection area; The details are as follows: For the first type of detection area, the unmanned target ship uses the second data acquisition device to obtain the depth of the subsurface objects in the target ship environment detection area from the water surface, obtains multiple depth values ​​of the objects from the water surface, and compares the multiple depth values ​​of the objects from the water surface with the underwater object detection reference depth values. When the object depth value from the water surface is less than the underwater object detection reference depth value, it is judged that the underwater object is a first type of obstacle, and the real-time longitude and latitude coordinates of the multiple first type obstacles are respectively obtained to obtain the longitude and latitude coordinates of the multiple obstacles; For the second type of detection area, the unmanned target ship detects objects above the water surface in the target ship environment detection area through the third data acquisition device, marks the objects above the water surface as second type obstacles, and acquires the real-time longitude and latitude coordinates of multiple second type obstacles to obtain the longitude and latitude coordinates of multiple obstacles.

3. The unmanned target ship control system based on position data according to claim 1 is characterized in that: Obstacle analysis data is obtained as follows: Obtain a real-time location marking map, name multiple obstacles in the real-time location marking map as the first obstacle to the nth obstacle, respectively mark them as two coordinate time monitoring points in the real-time location marking map, and name them as the first coordinate time monitoring point and the second coordinate time monitoring point, respectively, and the time interval between the first coordinate time monitoring point and the second coordinate time monitoring point is a characteristic monitoring duration; Determine the state of obstacles and obtain obstacle motion judgment classification data; The real-time moving speed of each moving obstacle is acquired respectively to obtain the real-time moving speed data of the moving obstacle; The obstacle motion judgment classification data and the real-time moving speed data of the moving obstacle are defined as obstacle analysis data.

4. The unmanned target ship control system based on position data according to claim 3 is characterized in that: Obtain obstacle motion judgment classification data, as follows: According to the real-time position mark map, the longitude and latitude coordinates of the first obstacle corresponding to the first coordinate time monitoring point and the second coordinate time monitoring point are obtained to obtain the first longitude and latitude coordinates and the second longitude and latitude coordinates. If the corresponding values ​​of the first longitude and latitude coordinates and the second longitude and latitude coordinates are the same, the first obstacle is judged to be a stationary obstacle. If the corresponding values ​​of the first longitude and latitude coordinates and the second longitude and latitude coordinates are different, the first obstacle is judged to be a moving obstacle. The above process of judging the motion state of the first obstacle is repeated, and the motion state of each obstacle is judged respectively to obtain obstacle motion judgment classification data.

5. The unmanned target ship control system based on position data according to claim 3 is characterized in that: The real-time moving speed data of moving obstacles is obtained as follows: If the first obstacle is a moving obstacle, the moving speed of the first obstacle is acquired to obtain the real-time moving speed of the first obstacle; The target ship sea area plane rectangular coordinate system corresponding to the unmanned target ship at the second coordinate time monitoring point is used as the obstacle speed monitoring coordinate system; Obtaining the plane rectangular coordinates of the first obstacle corresponding to the first coordinate time monitoring point and the second coordinate time monitoring point respectively through the obstacle speed monitoring coordinate system to obtain the first plane rectangular coordinate and the second plane rectangular coordinate; Respectively obtain the abscissa value and the ordinate value of the first plane rectangular coordinate and the second plane rectangular coordinate in the obstacle speed monitoring coordinate system to obtain a first abscissa value, a first ordinate value, a second abscissa value, and a second ordinate value; The real-time moving speed of the first obstacle is obtained by calculating the first horizontal coordinate value, the first vertical coordinate value, the second horizontal coordinate value, the second vertical coordinate value and the characteristic monitoring time corresponding to the first obstacle; Repeat the process of acquiring the real-time moving speed of the first obstacle, and acquire the real-time moving speed of each moving obstacle respectively to obtain the real-time moving speed data of the moving obstacle; The obstacle motion judgment classification data and the real-time moving speed data of the moving obstacle are defined as obstacle analysis data.