CN110764080A - Millimeter wave radar-based method for detecting piloting-following ship formation target in ship lock - Google Patents

Millimeter wave radar-based method for detecting piloting-following ship formation target in ship lock Download PDF

Info

Publication number
CN110764080A
CN110764080A CN201911043895.6A CN201911043895A CN110764080A CN 110764080 A CN110764080 A CN 110764080A CN 201911043895 A CN201911043895 A CN 201911043895A CN 110764080 A CN110764080 A CN 110764080A
Authority
CN
China
Prior art keywords
ship
distance
millimeter wave
wave radar
lock
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201911043895.6A
Other languages
Chinese (zh)
Other versions
CN110764080B (en
Inventor
柳晨光
贺治卜
初秀民
吴勇
郑茂
吴明洋
郭珏菡
吴文祥
雷超凡
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wuhan University of Technology WUT
Three Gorges Navigation Authority
Original Assignee
Wuhan University of Technology WUT
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Wuhan University of Technology WUT filed Critical Wuhan University of Technology WUT
Priority to CN201911043895.6A priority Critical patent/CN110764080B/en
Publication of CN110764080A publication Critical patent/CN110764080A/en
Application granted granted Critical
Publication of CN110764080B publication Critical patent/CN110764080B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/66Radar-tracking systems; Analogous systems
    • G01S13/72Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
    • G01S13/723Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02ATECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
    • Y02A10/00TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE at coastal zones; at river basins
    • Y02A10/30Flood prevention; Flood or storm water management, e.g. using flood barriers

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

The invention provides a method for detecting a piloting-following ship formation target in a ship lock based on a millimeter wave radar, wherein 1 long-distance millimeter wave radar acquires the information of an obstacle right in front of a ship; the three-dimensional ship comprises a ship body, three short-distance millimeter wave radars, a ship tail and a ship tail, wherein the three short-distance; acquiring an included angle between the initial direction of the ship and the direction of the lock chamber; according to the characteristic that the reflectivity of different materials is different, the targets received by the millimeter wave radar are distinguished to be a lock wall, a navigation ship, a following ship or other interferents; carrying out angle constraint processing on the radar which does not detect the navigation ship; identifying different situations, and calculating the relative distance between a front navigation ship and the ship, the distance between the ship and the gate walls on the left side and the right side, and the distance between the ship and a rear obstacle; and judging whether the continuous sailing is in danger of collision or the possibility of losing the target. The invention can accurately track the navigation ship in front of the following ship in the ship lock.

Description

Millimeter wave radar-based method for detecting piloting-following ship formation target in ship lock
Technical Field
The invention belongs to the field of waterway traffic, and particularly relates to a method for detecting a piloting-following ship formation target in a ship lock based on a millimeter wave radar.
Background
Since navigation of the three gorges ship lock, with high-speed and high-quality development of economy in China, the water transportation capacity is rapidly increased, the passing-lock transportation capacity is continuously increased, passing-lock ships are more and more popular, and the average ship waiting time is also increased year by year. The navigation-following ship formation cooperative lockage is an important measure for improving the lockage efficiency of ships, and how to acquire the motion states (relative motion speed and direction) between the ships in the formation is the basis for realizing the formation control. The maximum water level fall of a gate chamber of a ship in the three gorges-radix angelicae sinensis dam can usually reach more than 20 meters, GNSS signals are very weak at low water level, and the motion state perception among ships is difficult to realize through GNSS positioning; the problems of signal shielding and high cost exist by adopting the indoor positioning technology.
Disclosure of Invention
The technical problem to be solved by the invention is as follows: the method for detecting the formation target of the navigation-following ship in the ship lock based on the millimeter wave radar can accurately track the navigation ship in front of the following ship in the ship lock.
The technical scheme adopted by the invention for solving the technical problems is as follows: a method for detecting a piloting-following ship formation target in a ship lock based on a millimeter wave radar is characterized by comprising the following steps: for following a boat, comprising the steps of:
s1, information acquisition:
1 long-distance millimeter wave radar acquires information of an obstacle right in front of a ship; the three-dimensional ship comprises a ship body, three short-distance millimeter wave radars, a ship tail and a ship tail, wherein the three short-distance; acquiring an included angle between the initial direction of the ship and the direction of the lock chamber;
s2, obstacle distinguishing:
according to the characteristic that the reflectivity of different materials is different, the targets received by the millimeter wave radar are distinguished to be a lock wall, a navigation ship, a following ship or other interferents;
s3, carrying out angle constraint processing on the radar without detecting the navigation vessel;
s4, identifying different situations according to the information obtained in the S1, and calculating the relative distance between the front navigation ship and the ship, the distance between the ship and the gate walls on the left side and the right side of the ship, and the distance between the ship and the obstacle behind the ship;
s5, according to the result obtained in S4, it is judged whether there is a risk of collision or the possibility of missing the target while the vehicle is still underway.
According to the scheme, S1 specifically obtains the included angle between the ship initial direction and the lock chamber direction through the compass.
According to the scheme, when the millimeter wave radar is used for acquiring the obstacle information, S1 adopts the strategy of the maximum detection angle to detect the surrounding targets, and the target information returned by each millimeter wave radar is analyzed.
In the above-described scheme, in S2, the received object is distinguished by comparing the reflectance with the reflection area.
According to the above solution, in S4, the different scenarios include:
scenario 1: the advancing direction of the ship is consistent with the direction of the lock wall, namely the included angle of the ship relative to the advancing direction of the lock chamber is 0 degree; the distance d of the front ship is monitored by a long-distance millimeter wave radar arranged at the bow1At an angle of
Figure BDA0002253601040000021
The distance to the two side gate walls is d2、d3Distance d from the rear lock chamber4(ii) a The parameters were calculated as follows:
Figure BDA0002253601040000022
in the formula, c1The relative distance between the ship and the pilot ship, namely the projection of the linear distance between the ship and the pilot ship in the overall advancing direction of the ship formation;
scenario 2: the ship route has larger offset, namely the pilot ship is in a blind area detected by a long-distance millimeter wave radar following the ship bow and is detected by a short-distance millimeter wave radar on one side, the advancing direction of the pilot ship is inconsistent with the direction of the lock wall, the included angle of the ship relative to the advancing direction of the lock chamber is psi, and the distance d of the short-distance millimeter wave radar arranged on the left side of the ship and used for monitoring the foreship is2At an angle of
Figure BDA0002253601040000023
The distance of the obstacle measured by the short-distance millimeter wave radar on the right side is d3The rear obstacle distance is d4(ii) a The parameters were calculated as follows:
Figure BDA0002253601040000024
Figure BDA0002253601040000025
b2=d3cosψ (4)
b4=b2+lsinψ (5)
b1=W-b2-wcosψ (6)
b3=W-b4-wcosψ (7)
in the formula, c1The relative distance from the vessel to the vessel being piloted, c2The relative distance of the ship to the following ship, b1The distance from the left front end of the ship to the left end lock wall, b2The distance from the right front end of the ship to the right gate wall, b3The distance from the left back end of the ship to the left end lock wall, b4From the right back end to the left end of the shipThe distance between the lock walls, W is the width of the lock chamber, and W and l are the width and the length of the ship respectively;
scenario 3: the ship has great deviation of ship course, the advancing direction is not consistent with the direction of the lock wall, the included angle of the ship relative to the advancing direction of the lock chamber is psi, and the distance d of the ship before the ship is monitored by a short-distance millimeter wave radar arranged on the right side of the ship3At an angle of
Figure BDA0002253601040000026
The distance of the obstacle measured by the short-distance millimeter wave radar on the left side is d2The rear obstacle distance is d4(ii) a The parameters were calculated as follows:
Figure BDA0002253601040000027
Figure BDA0002253601040000028
b1=d2cosψ (10)
b3=b1+lsinψ (11)
b2=W-b1-wcosψ (12)
b4=W-b3-wcosψ(13)
in the formula, c1、c2、b1、b2、b3、b4W, W, l parameter definitions are the same as scenario 2;
scenario 4: the ship has a small deviation of the ship course, namely the pilot ship can be detected by a long-distance millimeter wave radar following the ship bow, but the advancing direction of the pilot ship is not consistent with the direction of the lock wall, the compass arranged in the center of the ship displays that the ship has an included angle psi relative to the advancing direction of the lock chamber, and the long-distance millimeter wave radar arranged in the front of the ship detects that the distance of the foreship is d1At an angle of
Figure BDA0002253601040000031
Short distance mm on right sideDistance of obstacle d measured by wave radar3The rear obstacle distance is d4(ii) a The parameters were calculated as follows:
Figure BDA0002253601040000032
Figure BDA0002253601040000033
b2=d3cosψ (16)
b4=b2-lsinψ 17)
b1=W-b2-wcosψ (18)
b3=W-b4-wcosψ (19)
in the formula, c1、c2、b1、b2、b3、b4W, l parameters are the same as scenario 2.
According to the scheme, the method further comprises the step of S7: if no pilot ship target is detected, S1-S6 is resumed.
According to the scheme, the method further comprises the step of S8: if the pilot ship target cannot be found through repeated detection for many times, the target tracking failure is defined, the navigation angle of the ship is corrected according to the included angle between the first direction of the ship and the lock chamber direction, and then detection is carried out.
The invention has the beneficial effects that: the millimeter wave radar is adopted, the method is suitable for detecting targets of ship formation in a lock chamber, has the advantages of low cost, high reliability and the like, and avoids the defects of inaccurate positioning and high indoor positioning cost in special environment of the lock chamber by using the traditional positioning device (such as GPS, Beidou and the like); the method for judging the type of the obstacle by distinguishing the reflectivity is adopted, and the detection mode of the millimeter wave radar is combined, so that whether the detected obstacle comes from a ship or a gate wall can be better distinguished; other obstacle information can be eliminated by a radar detection angle constraint mode, and the identification difficulty is reduced; the coordinate transformation formula is simple, and large errors cannot be caused.
Drawings
Fig. 1 is a schematic view of a mounting structure and a radar measurement area according to an embodiment of the present invention.
Fig. 2 is a schematic diagram of a type of view angle blind zone measured by the millimeter wave radar.
Fig. 3 is a schematic diagram of a millimeter wave radar measurement view angle blind zone type two.
Fig. 4 is a schematic diagram of a scenario 1 occurring in practical use of the present invention.
Fig. 5 is a schematic diagram of a scenario 2 occurring in the practical use of the present invention.
Fig. 6 is a schematic diagram of a scenario 3 occurring in the practical use of the present invention.
Fig. 7 is a schematic diagram of a scenario 4 occurring in the practical use of the present invention.
In the figure: 1-pilot ship, 2-own ship, 3-long-distance millimeter wave radar, 4-short-distance millimeter wave radar and 5-compass.
Detailed Description
The invention is further illustrated by the following specific examples and figures.
The invention provides a method for detecting a piloting-following ship formation target in a ship lock based on a millimeter wave radar, which is used for following ships and comprises the following steps of:
s1, information acquisition:
1 long-distance millimeter wave radar 3 acquires obstacle information right in front of the ship; the 3 short-distance millimeter wave radars 4 are respectively arranged at the center line positions of the left side of the bow, the right side of the bow and the stern, and are used for acquiring barrier information of the left side, the right side and the rear of the ship; the included angle between the initial direction of the ship and the direction of the lock chamber is obtained through a compass 5 arranged in the middle of the ship 2.
Wherein the return information of each millimeter wave radar includes: the reflection area, the target reflectivity, the target relative speed, the target angle, the target relative distance and other information of the target can effectively distinguish different types of targets (such as different reflectivity of a cement wall of a gate chamber and metal stripping of a ship and different display on a radar) by judging different reflectivity.
In fig. 1, the darker shaded area is the short range detection area (increasing the radar emission angle) of the radar, and the lighter shaded area is the long range detection area. In the pilot-following formation, it may happen that the following ship cannot track the pilot ship, i.e. the pilot ship is in the "view angle blind zone" scanned by the following ship radar, as shown in fig. 1 and 2. Wherein the darker shaded part is the short range detection zone of the radar (increasing the radar emission angle), and the lighter shaded part is the long range detection zone.
When the pilot ship is in the 'view angle blind area' of the following ship, the following ship cannot judge the specific position and speed of the pilot ship through a radar. If the following ship may lose the target and thus make a deviation in the course of the ship as shown in fig. 2; if the situation is as shown in fig. 3, the following ship may collide if it continues to travel, causing a large loss.
The emission angle of each millimeter wave radar is not restricted, the surrounding targets are explored by adopting a strategy of the maximum detection angle, and the target information returned by each radar is analyzed. As shown in fig. 1, when the transmission angle of the millimeter wave radar is not constrained, a larger detection angle can be obtained, wherein the detection angle of the short-distance millimeter wave radar is ± 28 °, the detection angle of the long-distance millimeter wave radar is ± 60 °, and thus the unconstrained transmission angle can obtain a larger detection area, so that each target around the ship can be better detected.
S2, obstacle distinguishing:
according to the characteristic that the reflectivity of different materials is different, the targets received by the millimeter wave radar are distinguished to be a lock wall, a navigation ship, a following ship or other interferents.
The invention is mainly applied to the formation detection in the ship lock, and the main radar reflection targets are as follows: the navigation boat (the material is mainly steel, and reflection area is great), the rear following boat (the material and reflection area are the same as above), the lock wall (the material is cement, and reflection area is the biggest), other interferents (surface garbage, other barriers, and the like, and the materials are different, and reflection area is less). The target which is perceived by the millimeter wave radar can be effectively distinguished by comparing the reflectivity and the reflection area.
S3, the radar which does not detect the pilot ship 1 is subjected to angle restraint processing, the detection area of the radar can be effectively reduced, the influence of other obstacles on radar detection is reduced, the detection precision of the radar is further improved, and the measurement result is more reliable. According to the measurement characteristics of the millimeter wave radar, the measurement distance and the measurement precision of the millimeter wave radar are obviously improved when the millimeter wave radar performs cluster detection, and the smaller the detection angle is, the longer the detection distance is. And the smaller the detection angle is, the fewer the targets can be detected by the detector, and other interference items are greatly reduced.
And S4, sending the target information obtained by each radar and the information of the included angle of the ship relative to the advancing direction of the lock chamber, measured by the compass, to the onboard computer, identifying different situations according to the information obtained in S1, and calculating the relative distance between the front pilot ship 1 and the ship 2, the distance between the ship 2 and the left and right lock walls, and the distance between the ship 2 and a rear obstacle.
Several possible situations in the lock room are listed below, and a localization analysis is performed for each situation.
Scenario 1: the distance d of the ship ahead is monitored by a long-distance millimeter wave radar arranged at the bow, which is approximately consistent with the direction of the ship and the direction of the lock wall (namely the included angle of the ship relative to the advancing direction of the lock chamber is approximately 0 degrees)1At an angle of
Figure BDA0002253601040000051
The distance to the two side gate walls is d2、d3(directly reading the distance measured by millimeter wave radar on both sides of the bow) and the distance to the rear lock chamber is d4. As shown in fig. 4.
The parameters were calculated as follows:
Figure BDA0002253601040000052
in the formula, c1The relative distance between the following ship and the pilot ship (the projection of the linear distance between the two ships in the overall advancing direction of the ship formation).
Scenario 2: following ship course is greatly deviated (namely the pilot ship is followingThe dead zone of the long-distance millimeter wave radar at the bow of the ship can be detected by the short-distance millimeter wave radar on one side, the advancing direction of the dead zone is not consistent with the direction of the lock wall), the compass arranged in the center of the ship displays that the included angle of the ship relative to the advancing direction of the lock chamber is psi, and the distance d of the ship ahead is detected by the short-distance millimeter wave radar arranged on the left side of the ship2At an angle of
Figure BDA0002253601040000053
The distance of the obstacle measured by the short-distance millimeter wave radar on the right side is d3The rear obstacle distance is d4. As shown in fig. 5. The parameters were calculated as follows:
Figure BDA0002253601040000054
Figure BDA0002253601040000055
b2=d3cosψ (4)
b4=b2+lsinψ (5)
b1=W-b2-wcosψ (6)
b3=W-b4-wcosψ (7)
in the formula, c1To follow the relative distance of the vessel to the lead vessel, c2To follow the relative distance of the ship to the following ship, b1To follow the distance from the left front end of the ship to the left end lock wall, b2To follow the distance from the right front end of the ship to the right end lock wall, b3To follow the distance from the left rear end of the vessel to the left end lock wall, b4In order to follow the distance from the right rear end of the ship to the gate wall at the left end, W is the width of the gate chamber, and W and l are the width and the length of the ship respectively.
Scenario 3: the ship-following course has large offset, its forward direction is not identical to the direction of lock wall, the compass mounted in the centre of ship can display that the ship has an included angle psi relative to the forward direction of lock chamber, and said ship-following course is mounted in the lock chamberThe distance d of the front ship monitored by the short-distance millimeter wave radar on the right side of the ship3At an angle ofThe distance of the obstacle measured by the short-distance millimeter wave radar on the left side is d2The rear obstacle distance is d4. As shown in fig. 6. The parameters were calculated as follows:
Figure BDA0002253601040000063
b1=d2cosψ (10)
b3=b1+lsinψ (11)
b2=W-b1-wcosψ (12)
b4=W-b3-wcosψ (13)
in the formula, c1、c2、b1、b2、b3、b4W, l parameters are defined the same as scenario 2.
Scenario 4: the ship-following course is slightly deviated (namely, the pilot ship can be detected by the long-distance millimeter wave radar at the bow of the pilot ship, but the advancing direction of the pilot ship is not consistent with the direction of the lock wall), the compass arranged in the center of the ship displays that the ship forms an included angle psi relative to the advancing direction of the lock chamber, and the long-distance millimeter wave radar arranged in the front of the ship detects that the distance of the front ship is d1At an angle of
Figure BDA0002253601040000064
The distance of the obstacle measured by the short-distance millimeter wave radar on the right side is d3The rear obstacle distance is d4. As shown in fig. 7. The parameters were calculated as follows:
Figure BDA0002253601040000066
b2=d3cosψ (16)
b4=b2-lsinψ (17)
b1=W-b2-wcosψ (18)
b3=W-b4-wcosψ (19)
in the formula, c1、c2、b1、b2、b3、b4W, l parameters are the same as scenario 2.
S5, according to the result obtained in S4, it is judged whether there is a risk of collision or the possibility of missing the target while the vehicle is still underway. The invention can set different safe distances according to different situations to judge whether the ship following air route is safe or not on different occasions, and how to adjust the air route if the ship following air route is unsafe.
Optionally, the method further includes S7: if no pilot ship target is detected, S1-S6 is resumed.
The method may further include S8: if the pilot ship target cannot be found through repeated detection for many times, the target tracking failure can be defined, the navigation angle of the ship can be corrected according to the angle information of the compass (the invention can effectively sense various obstacles in a sector area with the radius of 20 meters and the included angle of 236 degrees in front of the ship, and can effectively avoid some collision problems in the process of correcting the ship posture), and the long-distance millimeter wave radar in front of the corrected ship posture can effectively monitor the information of the pilot ship in front of the ship.
According to the invention, the millimeter wave radar is used as a sensing means, the following ship can obtain the distance and the relative movement speed of the surrounding target in real time, the relative movement state of the front navigation ship and the following ship can be accurately obtained through a design algorithm, and the reliable and accurate detection of the target of the front navigation ship is realized.
The above embodiments are only used for illustrating the design idea and features of the present invention, and the purpose of the present invention is to enable those skilled in the art to understand the content of the present invention and implement the present invention accordingly, and the protection scope of the present invention is not limited to the above embodiments. Therefore, all equivalent changes and modifications made in accordance with the principles and concepts disclosed herein are intended to be included within the scope of the present invention.

Claims (7)

1. A method for detecting a piloting-following ship formation target in a ship lock based on a millimeter wave radar is characterized by comprising the following steps: for following a boat, comprising the steps of:
s1, information acquisition:
1 long-distance millimeter wave radar acquires information of an obstacle right in front of a ship; the three-dimensional ship comprises a ship body, three short-distance millimeter wave radars, a ship tail and a ship tail, wherein the three short-distance; acquiring an included angle between the initial direction of the ship and the direction of the lock chamber;
s2, obstacle distinguishing:
according to the characteristic that the reflectivity of different materials is different, the targets received by the millimeter wave radar are distinguished to be a lock wall, a navigation ship, a following ship or other interferents;
s3, carrying out angle constraint processing on the radar without detecting the navigation vessel;
s4, identifying different situations according to the information obtained in the S1, and calculating the relative distance between the front navigation ship and the ship, the distance between the ship and the gate walls on the left side and the right side of the ship, and the distance between the ship and the obstacle behind the ship;
s5, according to the result obtained in S4, it is judged whether there is a risk of collision or the possibility of missing the target while the vehicle is still underway.
2. The object detection method according to claim 1, characterized in that: s1 specifically, an included angle between the ship fore direction and the lock chamber direction is obtained through a compass.
3. The object detection method according to claim 1, characterized in that: s1, when the millimeter wave radar is used for obtaining the obstacle information, the strategy of the maximum detection angle is adopted to detect the surrounding targets, and the target information returned by each millimeter wave radar is analyzed.
4. The object detection method according to claim 1, characterized in that: in S2, the received target is distinguished by comparing the reflectance with the reflection area.
5. The object detection method according to claim 1, characterized in that: at S4, the different scenarios include:
scenario 1: the advancing direction of the ship is consistent with the direction of the lock wall, namely the included angle of the ship relative to the advancing direction of the lock chamber is 0 degree; the distance d of the front ship is monitored by a long-distance millimeter wave radar arranged at the bow1At an angle of
Figure FDA0002253601030000011
The distance to the two side gate walls is d2、d3Distance d from the rear lock chamber4(ii) a The parameters were calculated as follows:
Figure FDA0002253601030000012
in the formula, c1The relative distance between the ship and the pilot ship, namely the projection of the linear distance between the ship and the pilot ship in the overall advancing direction of the ship formation;
scenario 2: the ship route has larger offset, namely the pilot ship is in a blind area detected by a long-distance millimeter wave radar following the ship bow and is detected by a short-distance millimeter wave radar on one side, the advancing direction of the pilot ship is inconsistent with the direction of the lock wall, the included angle of the ship relative to the advancing direction of the lock chamber is psi, and the distance d of the short-distance millimeter wave radar arranged on the left side of the ship and used for monitoring the foreship is2At an angle of
Figure FDA0002253601030000021
Obstacles measured by short-range millimeter-wave radar on right sideA distance d3The rear obstacle distance is d4(ii) a The parameters were calculated as follows:
Figure FDA0002253601030000022
Figure FDA0002253601030000023
b2=d3cosψ (4)
b4=b2+lsinψ (5)
b1=W-b2-wcosψ (6)
b3=W-b4-wcosψ (7)
in the formula, c1The relative distance from the vessel to the vessel being piloted, c2The relative distance of the ship to the following ship, b1The distance from the left front end of the ship to the left end lock wall, b2The distance from the right front end of the ship to the right gate wall, b3The distance from the left back end of the ship to the left end lock wall, b4The distance from the right rear end of the ship to the left end lock wall, W is the width of the lock chamber, and W and l are the width and the length of the ship respectively;
scenario 3: the ship has great deviation of ship course, the advancing direction is not consistent with the direction of the lock wall, the included angle of the ship relative to the advancing direction of the lock chamber is psi, and the distance d of the ship before the ship is monitored by a short-distance millimeter wave radar arranged on the right side of the ship3At an angle of
Figure FDA0002253601030000028
The distance of the obstacle measured by the short-distance millimeter wave radar on the left side is d2The rear obstacle distance is d4(ii) a The parameters were calculated as follows:
Figure FDA0002253601030000024
Figure FDA0002253601030000025
b1=d2cosψ (10)
b3=b1+lsinψ (11)
b2=W-b1-wcosψ (12)
b4=W-b3-wcosψ (13)
in the formula, c1、c2、b1、b2、b3、b4W, W, l parameter definitions are the same as scenario 2;
scenario 4: the ship has a small deviation of the ship course, namely the pilot ship can be detected by a long-distance millimeter wave radar following the ship bow, but the advancing direction of the pilot ship is not consistent with the direction of the lock wall, the compass arranged in the center of the ship displays that the ship has an included angle psi relative to the advancing direction of the lock chamber, and the long-distance millimeter wave radar arranged in the front of the ship detects that the distance of the foreship is d1At an angle of
Figure FDA0002253601030000026
The distance of the obstacle measured by the short-distance millimeter wave radar on the right side is d3The rear obstacle distance is d4(ii) a The parameters were calculated as follows:
Figure FDA0002253601030000027
b2=d3cosψ (16)
b4=b2-lsinψ (17)
b1=W-b2-wcosψ (18)
b3=W-b4-wcosψ (19)
in the formula, c1、c2、b1、b2、b3、b4W, l parameters are the same as scenario 2.
6. The object detection method according to claim 1, characterized in that: the method also includes S7: if no pilot ship target is detected, S1-S6 is resumed.
7. The object detection method according to claim 6, characterized in that: the method also includes S8: if the pilot ship target cannot be found through repeated detection for many times, the target tracking failure is defined, the navigation angle of the ship is corrected according to the included angle between the first direction of the ship and the lock chamber direction, and then detection is carried out.
CN201911043895.6A 2019-10-30 2019-10-30 Method for detecting navigation-following ship formation target in ship lock based on millimeter wave radar Active CN110764080B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911043895.6A CN110764080B (en) 2019-10-30 2019-10-30 Method for detecting navigation-following ship formation target in ship lock based on millimeter wave radar

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911043895.6A CN110764080B (en) 2019-10-30 2019-10-30 Method for detecting navigation-following ship formation target in ship lock based on millimeter wave radar

Publications (2)

Publication Number Publication Date
CN110764080A true CN110764080A (en) 2020-02-07
CN110764080B CN110764080B (en) 2023-08-15

Family

ID=69334655

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911043895.6A Active CN110764080B (en) 2019-10-30 2019-10-30 Method for detecting navigation-following ship formation target in ship lock based on millimeter wave radar

Country Status (1)

Country Link
CN (1) CN110764080B (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111290392A (en) * 2020-02-29 2020-06-16 长江三峡通航管理局 System and method for controlling formation and cooperative stop of ship passing through gate
CN115390055A (en) * 2022-08-10 2022-11-25 南京远能电力工程有限公司 Distribution network uninterrupted operation millimeter wave distance monitoring device and monitoring method thereof

Citations (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN204257002U (en) * 2014-07-18 2015-04-08 中国长江三峡集团公司 A kind of boats and ships are by the safety navigation backup system of ship lock
CN106601030A (en) * 2016-12-08 2017-04-26 中国交通通信信息中心 Intelligent lockage auxiliary navigation system for ship
CN107065878A (en) * 2017-05-12 2017-08-18 大连海事大学 A kind of automatic docking system of ship and method
CN107168329A (en) * 2017-06-20 2017-09-15 南京长峰航天电子科技有限公司 Based on the speed of a ship or plane course Collaborative Control formation navigation control method for following pilotage people's method
US20170365175A1 (en) * 2016-06-20 2017-12-21 Navico Holding As Watercraft navigation safety system
CN107728618A (en) * 2017-09-28 2018-02-23 南通大学 A kind of barrier-avoiding method of unmanned boat
CN108519581A (en) * 2018-03-26 2018-09-11 武汉丰蓝科技有限公司 The system and method that ship based on UWB positions in ship lock
CN109029465A (en) * 2018-08-24 2018-12-18 上海大学 A kind of unmanned boat tracking and obstacle avoidance system based on millimetre-wave radar
US20180361973A1 (en) * 2017-06-16 2018-12-20 Toyota Jidosha Kabushiki Kaisha Pre-collision control device
WO2019031115A1 (en) * 2017-08-10 2019-02-14 善郎 水野 Collision avoidance assistance system
CN109460035A (en) * 2018-12-18 2019-03-12 国家海洋局北海海洋工程勘察研究院(青岛环海海洋工程勘察研究院) Second level automatic obstacle avoiding system and barrier-avoiding method under a kind of unmanned boat fast state
CN109544994A (en) * 2019-01-23 2019-03-29 安徽理工大学 A kind of ship early warning system that ship lock is current
CN110029645A (en) * 2019-04-19 2019-07-19 长江三峡通航管理局 A kind of traffic control method that ship passes through the synchronous shifting berth of ship lock
CN110060509A (en) * 2019-03-29 2019-07-26 武汉船用机械有限责任公司 Ships that transport intelligent navigation method for early warning and ships that transport intelligent navigation prior-warning device
CN110208793A (en) * 2019-04-26 2019-09-06 纵目科技(上海)股份有限公司 DAS (Driver Assistant System), method, terminal and medium based on millimetre-wave radar

Patent Citations (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN204257002U (en) * 2014-07-18 2015-04-08 中国长江三峡集团公司 A kind of boats and ships are by the safety navigation backup system of ship lock
US20170365175A1 (en) * 2016-06-20 2017-12-21 Navico Holding As Watercraft navigation safety system
CN106601030A (en) * 2016-12-08 2017-04-26 中国交通通信信息中心 Intelligent lockage auxiliary navigation system for ship
CN107065878A (en) * 2017-05-12 2017-08-18 大连海事大学 A kind of automatic docking system of ship and method
US20180361973A1 (en) * 2017-06-16 2018-12-20 Toyota Jidosha Kabushiki Kaisha Pre-collision control device
CN107168329A (en) * 2017-06-20 2017-09-15 南京长峰航天电子科技有限公司 Based on the speed of a ship or plane course Collaborative Control formation navigation control method for following pilotage people's method
WO2019031115A1 (en) * 2017-08-10 2019-02-14 善郎 水野 Collision avoidance assistance system
CN107728618A (en) * 2017-09-28 2018-02-23 南通大学 A kind of barrier-avoiding method of unmanned boat
CN108519581A (en) * 2018-03-26 2018-09-11 武汉丰蓝科技有限公司 The system and method that ship based on UWB positions in ship lock
CN109029465A (en) * 2018-08-24 2018-12-18 上海大学 A kind of unmanned boat tracking and obstacle avoidance system based on millimetre-wave radar
CN109460035A (en) * 2018-12-18 2019-03-12 国家海洋局北海海洋工程勘察研究院(青岛环海海洋工程勘察研究院) Second level automatic obstacle avoiding system and barrier-avoiding method under a kind of unmanned boat fast state
CN109544994A (en) * 2019-01-23 2019-03-29 安徽理工大学 A kind of ship early warning system that ship lock is current
CN110060509A (en) * 2019-03-29 2019-07-26 武汉船用机械有限责任公司 Ships that transport intelligent navigation method for early warning and ships that transport intelligent navigation prior-warning device
CN110029645A (en) * 2019-04-19 2019-07-19 长江三峡通航管理局 A kind of traffic control method that ship passes through the synchronous shifting berth of ship lock
CN110208793A (en) * 2019-04-26 2019-09-06 纵目科技(上海)股份有限公司 DAS (Driver Assistant System), method, terminal and medium based on millimetre-wave radar

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
刘静;刘以安;杨新刚;: "基于Kalman滤波的船舶跟踪技术", 微计算机信息, no. 31 *
王贵槐;谢朔;柳晨光;初秀民;李梓龙;: "基于激光雷达的内河无人船障碍物识别方法", 光学技术, no. 05 *
钟诚;蒋仲廉;初秀民;罗翊;: "基于雷达影像的船舶转向角计算方法", 武汉理工大学学报(交通科学与工程版), no. 06 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111290392A (en) * 2020-02-29 2020-06-16 长江三峡通航管理局 System and method for controlling formation and cooperative stop of ship passing through gate
CN111290392B (en) * 2020-02-29 2020-11-06 长江三峡通航管理局 System and method for controlling formation and cooperative stop of ship passing through gate
CN115390055A (en) * 2022-08-10 2022-11-25 南京远能电力工程有限公司 Distribution network uninterrupted operation millimeter wave distance monitoring device and monitoring method thereof

Also Published As

Publication number Publication date
CN110764080B (en) 2023-08-15

Similar Documents

Publication Publication Date Title
US11768286B2 (en) Method of determining the yaw rate of a target vehicle
CN107728618B (en) Obstacle avoidance method of unmanned ship
US7592945B2 (en) Method of estimating target elevation utilizing radar data fusion
US7295150B2 (en) Methods and systems for identifying high-quality phase angle measurements in an interferometric radar system
US20150005993A1 (en) Method and device for measuring speed in a vehicle independently of the wheels
US20040178945A1 (en) Object location system for a road vehicle
CN112098990B (en) Method for detecting and tracking medium and high speed vehicle by vehicle-mounted high-resolution millimeter wave radar
CN110531357A (en) Estimate the method and radar sensing system of mobile target velocity magnitude in a horizontal plane
CN109460035A (en) Second level automatic obstacle avoiding system and barrier-avoiding method under a kind of unmanned boat fast state
US20240053468A1 (en) Vehicle-mounted bsd millimeter wave radar based method for obstacle recognition at low speed
CN110764080A (en) Millimeter wave radar-based method for detecting piloting-following ship formation target in ship lock
JP2008082974A (en) Object detector, object detecting method, and program executed by computer
CN111290410A (en) Millimeter wave radar-based automatic ship berthing and departing system and method
CN109358322A (en) Forward direction target detection radar and method
GB2370706A (en) Determining the position of a vehicle
JP2017015494A (en) Object detection device and object detection method
JP5074718B2 (en) Marine radar
US11798417B2 (en) Driving assistance device
CN109367529B (en) Millimeter wave radar combined installation structure and virtual tunnel construction and obstacle judgment method
JP2002122669A (en) Object position detecting method
CN106093458A (en) Single launching beam triantennary microwave speed and vehicle detect radar and detection method
WO2023057431A1 (en) Method for calibration of a radar system of a vehicle, radar system and vehicle
KR102298950B1 (en) synchronic positional tracking method using radar of multi unmanned aerial vehicles
CN209112162U (en) Millimetre-wave radar combines mounting structure
CN110542902B (en) Simple height measurement method suitable for vehicle millimeter wave radar

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
CB03 Change of inventor or designer information

Inventor after: Liu Chenguang

Inventor after: Lei Chaofan

Inventor after: Zhao Meng

Inventor after: Xu Zhipeng

Inventor after: Qi Junlin

Inventor after: Chu Xiumin

Inventor after: He Zhibo

Inventor after: Wu Yong

Inventor after: Zheng Mao

Inventor after: Wu Mingyang

Inventor after: Guo Juehan

Inventor after: Wu Wenxiang

Inventor before: Liu Chenguang

Inventor before: He Zhibo

Inventor before: Chu Xiumin

Inventor before: Wu Yong

Inventor before: Zheng Mao

Inventor before: Wu Mingyang

Inventor before: Guo Juehan

Inventor before: Wu Wenxiang

Inventor before: Lei Chaofan

CB03 Change of inventor or designer information
TA01 Transfer of patent application right

Effective date of registration: 20200728

Address after: 430070 Hubei Province, Wuhan city Hongshan District Luoshi Road No. 122

Applicant after: WUHAN University OF TECHNOLOGY

Applicant after: THREE GORGES NAVIGATION AUTHORITY

Address before: 430070 Hubei Province, Wuhan city Hongshan District Luoshi Road No. 122

Applicant before: WUHAN University OF TECHNOLOGY

TA01 Transfer of patent application right
GR01 Patent grant
GR01 Patent grant