阅读说明：本技术 基于激光雷达和导航雷达的多目标识别方法及系统 (Multi-target identification method and system based on laser radar and navigation radar ) 是由 倪侃俊 王新雅 袁敏 钱伟 张国兴 王南南 于 2019-08-05 设计创作，主要内容包括：本发明公开了一种基于激光雷达和导航雷达的多目标识别方法及系统,建立激光雷达坐标系,将极坐标下的角度和距离转化为笛卡尔坐标下的下x、y和z；建立导航雷达坐标系,以所述导航雷达为坐标原点建立二维平面坐标系x、y；使用导航雷达采集多目标数据；使用激光雷达传感器采集多目标数据；使用所述激光雷达传感器采集的所述多目标数据对所述使用导航雷达采集的多目标数据进行辅助,将所述导航雷达采集的所述多目标数据中的错误数据筛除。本发明提供的基于激光雷达和导航雷达的多目标识别方法及系统,无人水面艇上在自主航行中不受天气因素的影响,从而提高多目标的检测与跟踪能力。(The invention discloses a multi-target identification method and a multi-target identification system based on a laser radar and a navigation radar, wherein a laser radar coordinate system is established, and angles and distances under polar coordinates are converted into x, y and z under Cartesian coordinates; establishing a navigation radar coordinate system, and establishing a two-dimensional plane coordinate system x and y by taking the navigation radar as a coordinate origin; collecting multi-target data by using a navigation radar; collecting multi-target data by using a laser radar sensor; and using the multi-target data collected by the laser radar sensor to assist the multi-target data collected by the navigation radar, and screening out error data in the multi-target data collected by the navigation radar. According to the multi-target identification method and system based on the laser radar and the navigation radar, the unmanned surface vessel is not influenced by weather factors during autonomous navigation, and therefore the multi-target detection and tracking capacity is improved.)

1. A multi-target identification method based on laser radar and navigation radar is characterized by comprising the following steps:

establishing a laser radar coordinate system, and converting the angle and the distance under the polar coordinate into lower x, y and z under the Cartesian coordinate;

establishing a navigation radar coordinate system, and establishing a two-dimensional plane coordinate system x and y by taking the navigation radar as a coordinate origin;

collecting multi-target data using the navigation radar;

collecting multi-target data by using a laser radar sensor;

and using the multi-target data collected by the laser radar sensor to assist the multi-target data collected by the navigation radar, and screening out error data in the multi-target data collected by the navigation radar.

2. The lidar and navigation radar based multi-target identification method of claim 1, wherein the angles and distances in polar coordinates are converted to x, y, z in cartesian coordinates using the following equations to establish the lidar coordinate system:

wherein r is the measured distance, ω is the vertical angle of the laser, α is the horizontal rotation angle of the laser, and x, y, and z are the coordinates of the polar coordinates projected onto axis X, Y, Z.

3. The lidar and navigation radar based multi-target identification method of claim 1, wherein the navigation radar coordinate system is established with the navigation radar as the origin of coordinates, and the conversion relationship is as follows:

x_l＝x_m

y_l＝y_m

z_l＝z_m+0.2

wherein, a point coordinate l (x) is arranged in a three-dimensional coordinate system taking the laser radar as a coordinate origin_l，y_l，z_l) Corresponding to one point coordinate m (x) in a three-dimensional coordinate system with the navigation radar as a coordinate origin_m，y_m，z_m)。

4. The lidar and navigation radar based multi-target identification method of claim 1, wherein the multi-target data collected using the lidar sensor assists the multi-target data collected using the navigation radar by using a rational multiple sampling based asynchronous fusion algorithm:

step 1, mapping and unifying measured values from each sensor in a coordinate system of a fusion center and under a clock;

step 2, establishing a dynamic model describing the target state vectors at each observation point in the fusion period based on the difference between the predicted value of the target state at the next moment and the estimated value of the target state at the current moment;

step 3, according to the estimated value of the target state at the current moment based on the global information, combining the dynamic model and the traditional filter, and utilizing the measured values of the sensors which arrive in sequence in the period to estimate the target state at each observation point in sequence;

and 4, obtaining an estimated value of the target state at the next moment based on the global information.

5. The lidar and navigation radar based multi-target identification method of claim 1, wherein after a target is determined using the range and angle of the navigation radar, the number of targets returned around the target is determined using the lidar, and whether the target is adopted is determined according to the following nearest neighbor clustering method:

step 1: taking the sample Xi as an initial value of a first clustering center, and enabling Z1 to be X1;

step 2: calculating the Euclidean distance D21 to Z1 of the samples X2 | | | X2-Z1| |, if D21> T, defining a new clustering center Z2 ═ X2, otherwise X2 ∈ clustering with Z1 as the center;

and step 3: assuming that clustering centers Z1 and Z2 exist, calculating D31 | | | X3-Z1| | and D32 | | | X3-Z2| |, if D31> T and D32> T, establishing a third clustering center Z3 | X3, otherwise, the X3 belongs to the nearest clustering center in Z1 and Z2;

and 4, step 4: and so on until all N samples are classified;

the patterns { X1, X2, …, Xn } to be classified are classified into pattern classes with Z1, Z2, … as the clustering centers according to T,

where Z1 is a starting value and T is a preset distance threshold.

6. The lidar and navigation radar based multi-target identification method of claim 1, further comprising the steps of:

after a target is determined by using the distance parameter of laser navigation, a threshold value is set, and if the distance of the navigation radar exceeds the threshold value, the target is judged to be in error and is not adopted.

7. The lidar and navigation radar based multi-target identification method of claim 1, wherein the speed of the target ahead of the drone is based on the speed of the navigation radar.

8. The laser radar and navigation radar-based multi-target identification method according to claim 1, wherein the multi-target data uses a nearest neighbor algorithm to determine a moving target to which the target track points to be divided belong according to the moving target of at least one target track point which is nearest neighbor, so that a multi-target track is formed.

The parameters of the return angle, the distance and the speed of the mth moving object in the jth frame are assumed to be (theta)_jm，d_jm，v_jm) The coordinate of the coordinate system is (x) in a world coordinate system taking the laser radar sensor as the coordinate origin_j,m，y_j,m) Wherein x is_j,m＝d_jm·sinθ_jm，y_j,m＝d_jm·cosθ_jmThe distance d between the mth moving object in the jth frame and the kth moving object in the j +1 th frame of the next frame_k(k＝1，2，···n_j+1) The distance between two points is expressed as:

9. the lidar and navigation radar based multi-target identification method of claim 1, wherein the multi-target data is associated using joint probability data.

10. The lidar and navigation radar based multi-target identification method of claim 9, wherein the joint probability data association comprises a jth frame n_jTarget and j +1 th frame n_j+1And (3) associating the targets to generate a plurality of target association permutation combinations, multiplying the association probabilities of all the paired targets of the two adjacent frames, and taking the maximum probability value as the corresponding association permutation.

11. A system using the lidar and navigation radar based multi-target identification method of any one of claims 1 to 10, comprising:

the unmanned ship controller comprises an unmanned ship controller and a data processor, wherein the data processor comprises a laser detection processing module, a laser scanning control module, a centimeter wave radar baseband processing module and a waveform generating module;

the laser radar sensor comprises a laser transmitter and a laser receiver, the laser transmitter is connected with the laser detection processing module, and the laser receiver is connected with the laser scanning control module;

the navigation radar sensor comprises a radio frequency circuit, the radio frequency circuit sends a baseband signal to the centimeter wave radar baseband processing module, and the radio frequency circuit receives a modulation signal sent by the waveform generating module;

the unmanned ship controller is electrically connected with the power circuit, the interface chip and the clock circuit.

Technical Field

The invention relates to a multi-target identification method and a multi-target identification system, in particular to a multi-target identification method and a multi-target identification system based on a laser radar and a navigation radar.

Background

An Unmanned Surface Vessel (USV) is an intelligent small-sized Surface platform, and can replace manned Surface vessels to complete some fussy, complicated and even dangerous tasks in specific water areas. If various tasks are to be completed safely and autonomously under variable and complex sea conditions, the unmanned surface vessel must have good environment sensing capability, wherein accurate and stable obstacle detection capability is a precondition and a key technology for realizing autonomous navigation and obstacle avoidance of the unmanned surface vessel.

The target detection of the unmanned surface vessel is divided into a passive detection method and an active detection method. The passive detection method mainly adopts a monocular vision or stereoscopic vision sensor to sense the environmental information, and the characteristics of the sensor enable the method to obtain rich color characteristics in the surrounding environment of the platform, the processing mode of the environmental information generally utilizes an edge detection algorithm to process data, and a sea-sky and land-sky boundary line is extracted so as to distinguish a ground target and a suspended target, and then the target can be searched above or below the boundary line according to a target model according to different requirements. However, both of the two passive detection methods have certain defects, for example, the monocular vision method is often difficult to accurately obtain image depth information except for an ideal state, cannot position the target depth in the environment, is greatly interfered by illumination, and has a great difference from a final result obtained along with the change of illumination amount in the environment; the data volume and the calculation amount of the stereo vision detection method are huge, the real-time performance and the rapidity of the algorithm are difficult to guarantee, and the requirement for processing the environmental information in real time cannot be met.

The active detection method is to detect the targets around the unmanned surface vessel by using active sensors such as a navigation radar and a laser radar. The radar on an unmanned surface vessel is typically a navigation radar. The navigation radar adopts slot array antenna, work is in centimetre wave band, the range is nearer, the blind area is little, the precision and the resolving power in distance and position are higher, the ability of suppressing clutter such as sea and sleet is stronger, because its wavelength is longer relatively, detection distance is far away, and the technology is mature, long-range surface of water target detection and tracking in present mainly used, but because the detection precision restriction, the navigation radar can only provide the positional information of target for this ship usually, speed information, the shape characteristic of unable discernment target, and the navigation radar is in the blind area near this ship hull closely within range, can compensate closely the target observation through mode such as artifical lookout on large-scale ship, but under the prerequisite that needs unmanned operation to unmanned surface of water ship, the navigation radar can's safe navigation for unmanned surface of water ship provides the guarantee. The laser radar can be divided into a two-dimensional laser radar and a three-dimensional laser radar according to the number of the laser beams on the vertical plane, and the two laser radars can achieve good target detection effect. Laser is used as an active detection source for the laser radar, the wavelength of the laser is very short, so that the laser radar has the excellent characteristics of high measurement precision, strong anti-interference capability and the like, and the laser radar has the capability of being very suitable for short-distance target detection of the unmanned surface vessel. However, the laser radar has high requirements on working environment, is sensitive to weather change, has an unsatisfactory detection effect in severe weather such as rainy and snowy days, windy and sandy days and the like, has a limited detection range and tracks a few targets.

There is a need for a system that improves the ability of unmanned surface vessels to detect obstacles in a water environment.

Disclosure of Invention

The invention aims to solve the technical problem of providing a multi-target identification method and a multi-target identification system based on a laser radar and a navigation radar, so that the unmanned surface vessel is not influenced by weather factors during autonomous navigation, and the multi-target detection and tracking capability is improved.

The technical scheme adopted by the invention for solving the technical problems is to provide a multi-target identification method based on a laser radar and a navigation radar, which comprises the following steps:

establishing a laser radar coordinate system, and converting the angle and the distance under the polar coordinate into lower x, y and z under the Cartesian coordinate;

establishing a navigation radar coordinate system, and establishing a two-dimensional plane coordinate system x and y by taking the navigation radar as a coordinate origin;

collecting multi-target data using the navigation radar;

collecting multi-target data by using a laser radar sensor;

and using the multi-target data collected by the laser radar sensor to assist the multi-target data collected by the navigation radar, and screening out error data in the multi-target data collected by the navigation radar.

Preferably, the angles and distances in polar coordinates are converted to the following x, y, z in cartesian coordinates using the following equations to establish the lidar coordinate system:

wherein r is the measured distance, ω is the vertical angle of the laser, α is the horizontal rotation angle of the laser, and x, y, and z are the coordinates of the polar coordinates projected onto axis X, Y, Z.

Preferably, a navigation radar coordinate system is established by taking the navigation radar as a coordinate origin, and the conversion relation is as follows:

x_l＝x_m

y_l＝y_m

z_l＝z_m+0.2

wherein, the laser is usedA point coordinate l (x) in a three-dimensional coordinate system with a radar as a coordinate origin_l，y_l，z_l) Corresponding to one point coordinate m (x) in a three-dimensional coordinate system with the navigation radar as a coordinate origin_m，y_m，z_m)。

Preferably, the using the multi-target data collected by the lidar sensor to assist the multi-target data collected by the navigation radar includes using the following asynchronous fusion algorithm based on rational multiple sampling:

step 1, mapping and unifying measured values from each sensor in a coordinate system of a fusion center and under a clock;

step 2, establishing a dynamic model describing the target state vectors at each observation point in the fusion period based on the difference between the predicted value of the target state at the next moment and the estimated value of the target state at the current moment;

step 3, according to the estimated value of the target state at the current moment based on the global information, combining the dynamic model and the traditional filter, and utilizing the measured values of the sensors which arrive in sequence in the period to estimate the target state at each observation point in sequence;

and 4, obtaining an estimated value of the target state at the next moment based on the global information.

Preferably, after a target is determined by using the distance and the angle of the navigation radar, the number of targets returned around the target is determined by using the laser radar, and whether the target is adopted is judged according to the following nearest neighbor clustering method:

step 1: taking the sample Xi as an initial value of a first clustering center, and enabling Z1 to be X1;

step 2: calculating the Euclidean distance D21 to Z1 of the samples X2 | | | X2-Z1| |, if D21> T, defining a new clustering center Z2 ═ X2, otherwise X2 ∈ clustering with Z1 as the center;

and step 3: assuming that clustering centers Z1 and Z2 exist, calculating D31 | | | X3-Z1| | and D32 | | | X3-Z2| |, if D31> T and D32> T, establishing a third clustering center Z3 | X3, otherwise, the X3 belongs to the nearest clustering center in Z1 and Z2;

and 4, step 4: and so on until all N samples are classified;

the patterns { X1, X2, …, Xn } to be classified are classified into pattern classes with Z1, Z2, … as the clustering centers according to T,

where Z1 is a starting value and T is a preset distance threshold.

Preferably, the method further comprises the following steps:

after a target is determined by using the distance parameter of laser navigation, a threshold value is set, and if the distance of the navigation radar exceeds the threshold value, the target is judged to be in error and is not adopted.

Preferably, the speed of the target in front of the unmanned boat is based on the speed of the navigation radar.

Preferably, the multi-target data uses a nearest neighbor algorithm to determine a moving target to which the target track point to be divided belongs according to the moving target of at least one target track point of the nearest neighbor, so that a multi-target track is formed.

The parameters of the return angle, the distance and the speed of the mth moving object in the jth frame are assumed to be (theta)_jm，d_jm，v_jm) The coordinate of the coordinate system is (x) in a world coordinate system taking the laser radar sensor as the coordinate origin_j,m，y_j,m) Wherein x is_j,m＝d_jm·sinθ_jm，y_j,m＝d_jm·cosθ_jmThe distance d between the mth moving object in the jth frame and the kth moving object in the j +1 th frame of the next frame_k(k＝1，2，···n_j+1) The distance between two points is expressed as:

preferably, the multi-objective data is associated using joint probability data.

Preferably, the joint probabilistic data association comprises a jth frame n_jTarget and j +1 th frame n_j+1Associating each target to generate multiple target association permutation combinations, multiplying the association probabilities of all adjacent two-frame paired targets, and taking the maximum probability value as the corresponding association permutationAnd (4) columns.

Another technical solution adopted by the present invention to solve the above technical problems is to provide a system for multi-target identification method based on laser radar and navigation radar, including a method using the multi-target identification method based on laser radar and navigation radar, and further including:

the unmanned ship controller comprises an unmanned ship controller and a data processor, wherein the data processor comprises a laser detection processing module, a laser scanning control module, a centimeter wave radar baseband processing module and a waveform generating module;

the laser radar sensor comprises a laser transmitter and a laser receiver, the laser transmitter is connected with the laser detection processing module, and the laser receiver is connected with the laser scanning control module;

the navigation radar sensor comprises a radio frequency circuit, the radio frequency circuit sends a baseband signal to the centimeter wave radar baseband processing module, and the radio frequency circuit receives a modulation signal sent by the waveform generating module;

the unmanned ship controller is electrically connected with the power circuit, the interface chip and the clock circuit.

Compared with the prior art, the invention has the following beneficial effects: according to the multi-target identification method and system based on the laser radar and the navigation radar, a large number of invalid targets detected by the navigation radar are effectively filtered out by using data of the laser radar, only a few targets are tracked, the probability of multi-target data association of the laser radar and the navigation radar is greatly reduced, and the reliability of unmanned ship decision making is effectively improved. The unmanned surface vessel is not influenced by weather factors during autonomous navigation, so that the multi-target detection and tracking capability is improved.

Drawings

FIG. 1 is a schematic structural diagram of a multi-target identification system based on laser radar and navigation radar in an embodiment of the present invention;

FIG. 2 is a polar coordinate and XYZ coordinate mapping diagram of a lidar in an embodiment of the present invention;

FIG. 3 is a top view of a polar coordinate and XYZ coordinate map of a lidar in an embodiment of the present invention;

FIG. 4 is a schematic diagram of a navigation radar coordinate transformation according to an embodiment of the present invention.

Detailed Description

The invention is further described below with reference to the figures and examples.

In the following description, numerous specific details are set forth in order to provide a thorough understanding of the present invention. However, it will be apparent to one of ordinary skill in the art that the present invention may be practiced without these specific details. Accordingly, the particular details set forth are merely exemplary, and the particular details may be varied from the spirit and scope of the present invention and still be considered within the spirit and scope of the present invention.

According to the multi-target identification method and system based on the laser radar and the navigation radar, the unmanned surface vessel is not influenced by weather factors during autonomous navigation, and therefore the multi-target detection and tracking capacity is improved.

The embodiment discloses a multi-target identification method based on a laser radar and a navigation radar, which comprises the following steps:

establishing a laser radar coordinate system, and converting the angle and the distance under the polar coordinate into lower x, y and z under the Cartesian coordinate;

establishing a navigation radar coordinate system, and establishing a two-dimensional plane coordinate system x and y by taking the navigation radar as a coordinate origin;

collecting multi-target data by using a navigation radar;

collecting multi-target data by using a laser radar sensor;

and the multi-target data collected by the laser radar sensor is used for assisting the multi-target data collected by the navigation radar, and error data in the multi-target data collected by the navigation radar is screened out. Because the measurement accuracy of the laser radar is higher than that of the navigation radar, once multiple targets enter the range of the laser radar, the acquired data are more accurate.

Preferably, the angles and distances in polar coordinates are converted to the following x, y, z in cartesian coordinates using the following equations to establish the lidar coordinate system:

wherein r is the measured distance, ω is the vertical angle of the laser, α is the horizontal rotation angle of the laser, and x, y, and z are the coordinates of the polar coordinates projected onto axis X, Y, Z.

Referring to fig. 4, through analysis and research on the technology applied to the navigation radar, innovatively adopting a weighting mode in a rectangular coordinate system to improve the capturing, recording and tracking algorithms, and through five scene verifications required by international standards and combined with practical application verifications, comparison of experimental data and theoretical data shows that the algorithms can realize collision avoidance at high speed and high precision in a maneuvering state:

x＝x₀+ρcosθ

y＝y₀+ρsinθ

representing the coordinates of the center point of the scan. If the mathematical relationship of the above formula is directly used for coordinate transformation, the polar coordinate and the rectangular coordinate cannot be in one-to-one correspondence, and even dead spots and display blind spots occur. In scan conversion, adding a video sample-and-hold can effectively eliminate the "blind spot" problem. The dead point problem can be effectively solved by changing the angle quantization number.

In the implementation, a navigation radar coordinate system is established by taking the navigation radar as a coordinate origin.

In order to achieve a conversion between the lidar and the navigation radar coordinates, the relative spatial position of the lidar with respect to the navigation radar is measured. The height of the navigation radar is 160cm from the ground, and the distance of the laser radar is 180cm from the ground. The two sensors do not have relative displacement in the direction of sailing towards the unmanned ship, namely the positive direction of the shaft, and the two sensors do not have relative displacement in the left and right directions of the unmanned ship, namely the horizontal direction, and the conversion relation is as follows:

x₁＝x_m

y₁＝y_m

z₁＝z_m+0.2

wherein, a point coordinate l (x) is arranged in a three-dimensional coordinate system taking the laser radar as a coordinate origin₁，y₁，z₁) In meters. Corresponding to a point coordinate m (x) in a three-dimensional coordinate system with the navigation radar as the coordinate origin_m，y_m，z_m) In meters.

In a specific implementation, the using the multi-target data collected by the lidar sensor to assist the multi-target data collected by the navigation radar includes using an asynchronous fusion algorithm based on rational multiple sampling. Step 1, mapping and unifying measured values from each sensor in a coordinate system of a fusion center and under a clock; step 2, establishing a dynamic model describing the target state vectors at each observation point in the fusion period based on the difference between the predicted value of the target state at the next moment and the estimated value of the target state at the current moment; step 3, according to the estimated value of the target state at the current moment based on the global information, combining the dynamic model and the traditional filter, and utilizing the measured values of the sensors which arrive in sequence in the period to estimate the target state at each observation point in sequence; and 4, obtaining an estimated value of the target state at the next moment based on the global information.

Multi-sensor fusion systems can generally be divided into two categories, synchronous and asynchronous fusion. Conventional multi-sensor fusion algorithms are mostly based on the simultaneous measurement of ratios and simultaneous arrival of the sensor measurement data. In practice, due to the different types of sensors or tasks used, each sensor has different sampling rates and transmission delays, in which case the synchronization of the measurements is difficult to achieve. The asynchronous fusion algorithm based on rational multiple sampling adopted by the invention has better effect in actual simulation, has certain advantages in the aspect of state estimation precision, and needs to solve various error problems in asynchronous fusion.

After a target is determined by using the distance and the angle of a navigation radar, the number of targets returned around the target is determined by using a laser radar, whether the target is adopted or not is judged according to the following nearest neighbor clustering method, and the step 1: taking the sample Xi as an initial value of a first clustering center, and enabling Z1 to be X1; step 2: calculating the Euclidean distance D21 to Z1 of the samples X2 | | | X2-Z1| |, if D21> T, defining a new clustering center Z2 ═ X2, otherwise X2 ∈ clustering with Z1 as the center; and step 3: assuming that clustering centers Z1 and Z2 exist, calculating D31 | | | X3-Z1| | and D32 | | | X3-Z2| |, if D31> T and D32> T, establishing a third clustering center Z3 | X3, otherwise, the X3 belongs to the nearest clustering center in Z1 and Z2; and 4, step 4: and so on until all N samples are classified; the patterns { X1, X2, …, Xn } to be classified are classified into pattern classes with Z1, Z2, … as the cluster center according to T, wherein Z1 is a starting value, and T is a preset distance threshold. This is because the navigation radar has undoubtedly an advantage in accuracy in the selection of the target angle parameter.

After a target is determined by using the distance parameter of laser navigation, a threshold value is set, and if the distance of the navigation radar exceeds the threshold value, the target is judged to be in error and is not adopted. The asynchronous fusion of the laser radar and the navigation radar distance data not only improves the data precision, but also can filter abnormal data, and improves the stability and the reliability of a multi-sensor system, which is also the advantage of the multi-sensor system relative to a single sensor.

In a specific implementation, the speed of the target in front of the unmanned boat is based on the speed of the navigation radar. The speed of the target in front of the unmanned ship after asynchronous fusion of the two sensors mainly depends on the speed of the navigation radar. The accuracy of the navigation radar in measuring speed at medium distance and long distance is 0.12m/s, which is the speed measurement accuracy of the multi-sensor system.

In specific implementation, the multi-target data uses a nearest neighbor algorithm to determine a moving target to which a target track point to be divided belongs according to a moving target of at least one target track point of the nearest neighbor, so that a multi-target track is formed.

The parameters of the return angle, the distance and the speed of the mth moving object in the jth frame are assumed to be (theta)_jm，d_jm，v_jm) The coordinate of the coordinate system is (x) in a world coordinate system taking the laser radar sensor as the coordinate origin_j,m，y_j,m) Wherein x is_j,m＝d_jm·sinθ_jm，y_j,m＝d_jm·cosθ_jmThe distance d between the mth moving object in the jth frame and the kth moving object in the j +1 th frame of the next frame_k(k＝1，2，···n_j+1) The distance between two points is expressed as:

when a single navigation radar sensor is relied on to report the azimuth, distance and speed information of a series of targets, the positions of the targets must be connected according to the chronological order in order to calculate the track of the targets, and if the targets are single targets, the method is relatively simple to implement. However, in practical situations, the probability of a single target appearing all the time is very small, and when multiple targets appear, even if the track of each target is drawn, after one sampling period, a plurality of new target data are reported, but the target data are specifically associated with the existing target track, and have a plurality of possibilities, of course, the target data are not associated with all the existing tracks, but new targets appear at the moment. In the face of the situation, people research a plurality of tracking algorithms, and the algorithms solve part of problems to a certain extent, but because the calculated amount is too large, the real-time performance is not good, and the large-scale popularization is not achieved in the practical application. Therefore, the technical scheme of the invention assists the navigation radar in maintaining the tracks of multiple targets by means of the characteristics of the laser radar sensor, obviously reduces the wrongly associated tracks and achieves good effect.

The core idea of the nearest neighbor algorithm (kNN, k-nearest neighbor) is that if a sample is classified in one type for the majority of its k nearest neighbors in the feature space, then the sample also belongs to this class and has the features of the samples on that class. In the method, the classification decision is determined according to the classification of one or more samples in the nearest neighbor.

The general flow of the kNN algorithm is as follows:

step 1: initializing the distance to be the maximum value;

step 2: calculating the distance dist between the unknown sample and each training sample;

and step 3: obtaining the maximum distance maxdist in the current K nearest samples;

and 4, step 4: if dist is smaller than maxdist, then the training sample is used as the K-nearest neighbor sample;

and 5: repeating the steps 2, 3 and 4 until the distances between the unknown samples and all the training samples are calculated;

step 6: counting the occurrence frequency of each class label in the K-nearest neighbor sample;

and 7: the class label with the highest frequency of occurrence is the class label of the least known sample.

In a specific implementation, the joint probabilistic data association comprises a jth frame n_jTarget and j +1 th frame n_j+1And (3) associating the targets to generate a plurality of target association permutation combinations, multiplying the association probabilities of all the paired targets of the two adjacent frames, and taking the maximum probability value as the corresponding association permutation.

The embodiment also discloses a multi-target identification system based on the laser radar and the navigation radar, which comprises a method for using the multi-target identification method based on the laser radar and the navigation radar, and further comprises the following steps:

the unmanned ship controller comprises an unmanned ship controller and a data processor, wherein the data processor comprises a laser detection processing module, a laser scanning control module, a centimeter wave radar baseband processing module and a waveform generating module;

the laser radar sensor comprises a laser transmitter and a laser receiver, the laser transmitter is connected with the laser detection processing module, and the laser receiver is connected with the laser scanning control module;

the navigation radar sensor comprises a radio frequency circuit, the radio frequency circuit sends a baseband signal to the centimeter wave radar baseband processing module, and the radio frequency circuit receives a modulation signal sent by the waveform generating module;

the unmanned ship controller is electrically connected with the power circuit, the interface chip and the clock circuit.

In summary, according to the multi-target identification method and system based on the laser radar and the navigation radar provided by the embodiment, a large number of invalid targets detected by the navigation radar are effectively filtered by using data of the laser radar, only a few targets are tracked, the probability of multi-target data association of the laser radar and the navigation radar is greatly reduced, and the reliability of unmanned ship decision making is effectively improved. The unmanned surface vessel is not influenced by weather factors during autonomous navigation, so that the multi-target detection and tracking capability is improved.

Although the present invention has been described with respect to the preferred embodiments, it will be understood by those skilled in the art that various changes in form and details may be made therein without departing from the spirit and scope of the invention as defined by the appended claims.