CN105180943B - Ship-positioning system and method - Google Patents

Ship-positioning system and method Download PDF

Info

Publication number
CN105180943B
CN105180943B CN201510593166.3A CN201510593166A CN105180943B CN 105180943 B CN105180943 B CN 105180943B CN 201510593166 A CN201510593166 A CN 201510593166A CN 105180943 B CN105180943 B CN 105180943B
Authority
CN
China
Prior art keywords
position information
ship
point
positioning
coordinates
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.)
Expired - Fee Related
Application number
CN201510593166.3A
Other languages
Chinese (zh)
Other versions
CN105180943A (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.)
Jiangsu Zhongda Dongbo Information Science & Technology Co Ltd
Original Assignee
Jiangsu Zhongda Dongbo Information Science & Technology Co Ltd
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 Jiangsu Zhongda Dongbo Information Science & Technology Co Ltd filed Critical Jiangsu Zhongda Dongbo Information Science & Technology Co Ltd
Priority to CN201510593166.3A priority Critical patent/CN105180943B/en
Publication of CN105180943A publication Critical patent/CN105180943A/en
Application granted granted Critical
Publication of CN105180943B publication Critical patent/CN105180943B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/203Specially adapted for sailing ships

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

The invention discloses a kind of ship-positioning system, including: location information acquiring unit, for obtaining multiple positional informationes of boats and ships from multiple different positioning ends;Sequencing unit, for being ranked up the multiple positional informationes got according to priority, sends priority to integrated unit more than the multiple positional informationes setting threshold value;Integrated unit, merges priority more than the multiple positional informationes setting threshold value, draws unique boats and ships latitude and longitude coordinates;Monitoring unit, for obtaining ship monitor image according to boats and ships latitude and longitude coordinates.The present invention can realize being accurately positioned of boats and ships.

Description

Ship positioning system and method
Technical Field
The invention belongs to the field of traffic, and particularly relates to a ship positioning system and method.
Background
At present, many identity recognition systems are installed in maritime affairs for ships on inland waterway, such as ship-borne Automatic Identification System (AIS), Radio Frequency Identification (RFID), inter-site test signals (VITS), satellite positioning, radar, etc. Each system has a longitude and latitude position, which results in that the background system cannot judge which longitude and latitude position is accurate. In addition, since these systems exist alone, they cannot be linked to a closed circuit television camera (CCTV), which may result in the failure of the maritime department to confirm the identity of the ship by viewing the CCTV video. CCTV and positioning system are separated in current maritime affairs system, or can only look over the real-time video of boats and ships through CCTV, or can only look over the position of boats and ships on the map through positioning system, and this kind of mode has a very big shortcoming, and maritime affairs personnel can't pass through CCTV alone or the information of AIS accurate positioning boats and ships.
Disclosure of Invention
Aiming at the defects of the prior art, the invention provides a ship positioning system and a ship positioning method.
A vessel locating system comprising: the positioning device comprises a position information acquisition unit, a positioning unit and a positioning unit, wherein the position information acquisition unit is used for acquiring a plurality of position information of a ship from a plurality of different positioning ends; the sorting unit is used for sorting the acquired position information according to priority and sending the position information with the priority greater than a set threshold value to the fusion unit; the fusion unit is used for fusing a plurality of position information with the priority level larger than a set threshold value to obtain a unique ship longitude and latitude coordinate; and the monitoring unit is used for acquiring a ship monitoring image according to the longitude and latitude coordinates of the ship.
Optionally, the position information includes the current longitude and latitude of the ship, the time of acquiring the position information, and the identifier of the positioning end.
Optionally, the sorting the acquired position information according to priority includes: subtracting the current time from the time of the ship position information acquired by each positioning end to obtain the time length of the position information sent by each positioning end from the current time, and sequencing the position information according to the priority sequence of the time lengths from small to large.
Optionally, the plurality of different positioning ends include: AIS, RFID, VITS, satellite positioning, and/or radar.
Optionally, the fusing the position information with the priority greater than the set threshold to obtain the unique ship longitude and latitude coordinate specifically includes: at the current moment t, the real position of the ship at the moment is set as PtBefore time t, the position coordinates in the position information with the priority greater than the set threshold are Let A, V, G be the three coordinates corresponding to three points respectively, and the vector velocity beAnd are respectively distant from time tCalculating the reference position of the ship at the time t according to the coordinates and the vector speedWherein:
and (B) point A:
point V:
and point G:
using the earth as a reference system, calculating A, V, G reference center and earth coordinates corresponding to the three points as (B)A,LA,HA)、(BV,LV,HV)、(BG,LG,HG) The coordinate system takes the center of a reference ellipsoid as a coordinate origin, and the short axis of the ellipsoid is superposed with the rotating axis of the reference ellipsoid; b is the geodetic latitude, which is the included angle between the normal of the ellipsoid passing through the ground point and the equatorial plane of the ellipsoid; l is the geodetic longitude, such thatAn included angle between the ellipsoid meridian plane passing through the ground point and the initial meridian plane; h is the height of the ground;
converting geodetic coordinates into space rectangular coordinates, wherein the conversion formula is as follows:
in a space rectangular coordinate system, 1) taking a reference center O as a coordinate origin; 2) the Z axis coincides with the short axis of the reference ellipsoid; 3) the X axis is superposed with the intersection line of the initial meridian plane and the equator; 4) the Y axis is vertical to the X axis on the equatorial plane to form a right-hand rectangular coordinate system O-XYZ; in the formula (4), N is the curvature radius of the ellipsoidal unitary-ground ring, e is the first eccentricity of the ellipsoid, the long and short radii of the ellipsoids a and b, and W is the first auxiliary coefficient; wherein: a is 6378.137 km; b is 6356.7523141 km;
N = a W - - - ( 5 )
the coordinates of the A, V, G points are substituted into the formulas (5) - (7), and the spatial rectangular coordinates corresponding to A, V, G are calculated to be (X)A,YA,ZA)、(XV,YV,ZV)、(XG,YG,ZG) (ii) a Fusing A, V, G points into one point, making the point be the S point, the algorithm is as follows:
X s = X A + X V + X G 3 Y s = Y A + Y V + Y G 3 Z s = Z A + Z V + Z G 3 - - - ( 8 )
the coordinate of the S point is obtained as (X)S,YS,ZS) (ii) a In order to obtain longitude and latitude coordinates, the space rectangular coordinates are converted into geodetic coordinates, and the conversion formula is as follows:
after the processing of the fusion unit, the unique longitude and latitude coordinate S point is obtained as (B)S,LS,HS)。
Optionally, the method for obtaining a ship monitoring image according to a ship longitude and latitude coordinate specifically includes: setting the obtained longitude and latitude coordinates of the ship as an S point, and obtaining the horizontal distance a between the camera and the S point1Distance b between camera and ground1As is known, according to the right-angled triangle pythagorean theorem:
c = a 1 2 + b 1 2 - - - ( 10 )
the distance c between the camera and the point S is obtained, so that the focal length of the camera is adjusted, and according to the right-angle surface, the depression angle alpha of the camera can be determined to be:
α = arcsin a 1 c - - - ( 11 )
then, the true azimuth angle of the point S relative to the camera is calculated, namely, the horizontal included angle between the line from the true north direction line of a certain point to the target direction line along the clockwise direction is calculated, and the true azimuth angle is calculated by adopting a station-centered horizontal coordinate system; assuming that the position of the camera is M point, the geodetic coordinate of the point is (B)M,LM,HM) Converted into spatial rectangular coordinates, i.e. (X), by the coordinate conversion formula (4) described aboveM,YM,ZM) Taking a coordinate system where the M point is located as a station center rectangular coordinate system and recording as M-NEU, knowing spatial rectangular coordinates of the M point and the S point, and obtaining the following results according to the translation and rotation relationship between the two coordinate systems:
wherein,
R 1 = 1 0 0 0 - 1 0 0 0 1 - - - ( 16 )
thus, the coordinates (N, E, U) of point S in the station-centric horizontal coordinate system at point M are found:
N E U = - sinB M cosL M - sinL M sinB M cosB M - sinL M cosL M 0 cosB M cosL M cosB M sinL M sinB M * X S - X M Y S - Y M Z S - Z M - - - ( 17 )
the azimuth angle from point M to point S is: theta as arctan (E/N) (18)
And adjusting the position of the camera according to the true azimuth angle theta.
A method of locating a vessel, comprising the steps of: s100: acquiring a plurality of position information of a ship from a plurality of different positioning ends; s200: sequencing the acquired position information according to priority, and sending the position information with the priority greater than a set threshold to a fusion unit; s300: fusing a plurality of position information with the priority greater than a set threshold value to obtain a unique ship longitude and latitude coordinate; s400: and acquiring a ship monitoring image according to the longitude and latitude coordinates of the ship.
Optionally, the position information includes the current longitude and latitude of the ship, the time of acquiring the position information, and the identifier of the positioning end.
Optionally, step S200 specifically includes: subtracting the current time from the time of the ship position information acquired by each positioning end to obtain the time length of the position information sent by each positioning end from the current time, and sequencing the position information according to the priority sequence of the time lengths from small to large.
Optionally, the plurality of different positioning ends include: AIS, RFID, VITS, satellite positioning, and/or radar.
The invention has the beneficial effects that: according to the invention, the longitude and the latitude are obtained through the fusion algorithm of the longitude and latitude positions and then linked with the monitoring system, so that maritime personnel can accurately know the relevant information of the ship in the video, and the ship can be accurately positioned for video monitoring.
Drawings
FIG. 1 is a schematic diagram of the configuration of the vessel positioning system of the present invention;
FIG. 2 is a spatial geodetic coordinate system;
FIG. 3 is a rectangular spatial coordinate system;
FIG. 4 is a schematic diagram of the monitoring unit linked with the point S;
FIG. 5 is a schematic diagram of a isocenter rectangular coordinate system and a spatial rectangular coordinate system;
fig. 6 is a flow chart of the vessel positioning method of the present invention.
Detailed Description
The above and other objects, features and advantages of the present invention will become more apparent from the following detailed description of the preferred embodiments of the present invention when taken in conjunction with the accompanying drawings. Like reference numerals refer to like parts throughout the drawings. The drawings are not intended to be to scale, emphasis instead being placed upon illustrating the principles of the invention.
Example 1
As shown in fig. 1, the ship positioning system of the present invention includes a position information acquiring unit, a sorting unit, a fusion unit, and a monitoring unit, which are connected in sequence. The system firstly collects ship position information uploaded by all positioning ends through a position information acquisition unit, and then a unique longitude and latitude information is obtained through judgment and calculation of a sorting unit and a fusion unit through related rules and is used for accurately representing the geographical position of a ship. The system sends the accurate geographic position to the monitoring unit, and the monitoring unit combines the uploaded geographic position according to the ship image in the video range thereof, and can design a floating window above the ship in the video for displaying the relevant information of the ship.
A position information acquiring unit for acquiring a plurality of position information of the ship from different positioning terminals, generally speaking, a plurality of positioning terminals are installed on the ship, such as a first positioning terminal (which may be AIS), a second positioning terminal (which may be RFID), a third positioning terminal (VITS), a fourth positioning terminal (which may be GPS), a fifth positioning terminal (which may be radar), etc., the position information acquiring unit receives ship position information transmitted by various positioning terminals, the ship position information may include the latitude and longitude of the current position of the ship, the time of acquiring the position information, and the positioning end identifier, etc., and it should be noted that the positioning end identifier in the present invention refers to an identifier indicating which positioning end the position information is acquired from, for example, for the fourth positioning end, the fourth positioning end obtains the position information (.tGGPS) is: (31.203181, 121.505543), 20150910153008, GPS; the piece of information shows that the ship is currently at the north latitude N31 degrees 20 '31.81' east longitude E121 degrees 50 '55.43', the acquisition time of the position information is 2015, 9, 10, 15, 30 min and 08 sec, the position information is acquired from a GPS positioning end, the GPS in the information is a positioning mark, PGRepresenting the position coordinates of the vessel. Different location terminals have different location identifications, for example, the location identification of AIS may be AIS, and the location identification of RFID may be RFID, etc.
The position information acquisition unit sends the acquired position information to the sequencing unit, and the sequencing unit is mainly used for sequencing the acquired position information according to the priority and sending the position information with the priority greater than a set threshold to the fusion unit. Specifically, the position information acquiring unit may acquire the position information sent by different positioning terminals at different times, in order to ensure that the ship obtained by the subsequent fusion algorithmThe accuracy of the ship position needs to sort the position information, the priority sorting is carried out according to the acquisition time of the positioning information, and the positioning information with the later priority is discarded after the sorting, so that the positioning information used by the fusion algorithm is the latest positioning information, and the positioning accuracy is improved. For example, before the current time t, the last position information provided by the first positioning end, the second positioning end, the third positioning end and the fourth positioning end is: (tA、AIS)、(tR、RFID)、(tV、VITS)、(tGGPS), whereinRespectively representing the position coordinates t of the ship obtained by the first positioning end, the second positioning end, the third positioning end and the fourth positioning endA、tR、tV、tGThe time of the ship position information acquired by the first positioning end, the second positioning end, the third positioning end and the fourth positioning end is respectively represented, and the AIS, the RFID, the VITS and the GPS respectively represent positioning marks of the first positioning end, the second positioning end, the third positioning end and the fourth positioning end. After the position information is obtained, the sequencing unit firstly reads the positioning identification in the information so as to determine which positioning end the position information comes from, and then the sequencing unit subtracts the time of the obtained ship position information from the current time t so as to obtain the time length of the position information sent by different positioning ends from the current time t, namely the time lengthIn the formulaRespectively showing the time length of the position information sent by the first positioning end, the second positioning end, the third positioning end and the fourth positioning end from the current moment. After acquiring the time lengths of the position information sent by different positioning ends from the current time t, the sorting unit compares the time lengths, and sorts the time lengths in a descending order, for example, the sorting result is as follows:this means that the positioning information obtained from the first positioning end has the shortest time length from the current time t, and the positioning information obtained from the fourth positioning end has the longest time length from the current time t. The sequencing unit sequences the acquired position information according to the priority, and the sequencing result is as follows: the first positioning end is larger than the third positioning end and larger than the fourth positioning end and larger than the second positioning end, if the first positioning end, the second positioning end, the third positioning end and the fourth positioning end respectively represent AIS, RFID, VITS and GPS, the priority of the position information obtained from the four positioning ends is as follows: AIS > VITS > GPS > RFID. That is, the priorities of the four systems are 1, 2, 3, and 4, respectively, and if the threshold set by the system is 2, the sorting unit sends the position information acquired from the first positioning terminal and the third positioning terminal to the merging unit, and if the threshold set by the system is 3, the sorting unit sends the position information acquired from the first positioning terminal, the third positioning terminal, and the fourth positioning terminal to the merging unit.
And the fusion unit is used for receiving the position information with the priority level larger than the set threshold value sent by the sorting unit and fusing the position information with the priority level larger than the set threshold value to obtain the unique ship longitude and latitude coordinates. Specifically, the sorting unit sends the position information obtained from the first positioning end, the third positioning end, and the fourth positioning end to the fusion unit. According to the sequence, a first positioning terminal, a third positioning terminal and a fourth positioning terminal (AI) are obtainedS, VITS, satellite positioning) are provided as position coordinates PA、PV、PG. At a specific time t, the real position of the ship is set as Pt. Before time t, the AIS, VITS and satellite positioning provide the last position coordinates respectivelyLet A, V, G be the three coordinates corresponding to the three points, respectively. Vector velocity ofAnd are respectively distant from time tAccording to the coordinates and the vector speed, the reference position of the ship at the time t can be calculatedWherein:
and (B) point A:
point V:
and point G:
as shown in FIG. 2, using the earth as a reference system, the coordinates of the center of gravity corresponding to A, V, G are obtained from the reference position as (B)A,LA,HA)、(BV,LV,HV)、(BG,LG,HG) The coordinate system takes the center of a reference ellipsoid as a coordinate origin, and the short axis of the ellipsoid is superposed with the rotating axis of the reference ellipsoid; b is the latitude of the earth, which is an ellipse passing through the ground pointThe included angle between the normal line of the sphere and the equatorial plane of the ellipsoid; l is the earth longitude, and is the included angle between the ellipsoid meridian plane passing through the ground point and the initial meridian plane; h is the geodetic height, and since the coordinates of the longitude and latitude of each point and the distance between each point are nonlinearly transformed, in order to obtain a unique longitude and latitude, the geodetic coordinates are converted into spatial rectangular coordinates, and the conversion formula is as follows:
as shown in fig. 3, in the rectangular spatial coordinate system, 1) the reference center O is used as the origin of coordinates; 2) the Z axis coincides with the minor axis (rotation axis) of the reference ellipsoid; 3) the X axis is superposed with the intersection line of the initial meridian plane and the equator; 4) the Y axis is vertical to the X axis on the equatorial plane to form a right-hand rectangular coordinate system O-XYZ; in the formula, N is the curvature radius of the ellipsoidal unitary-ground ring, e is the first eccentricity of an ellipsoid, the long and short radii of the ellipsoids a and b, and W is a first auxiliary coefficient; wherein: a is 6378.137 km; b is 6356.7523141 km;
N = a W - - - ( 5 )
the coordinates of A, V, G are substituted into the above formula to obtain A, V, G corresponding spatial rectangular coordinates (XA, YA, ZA), (XV, YV, ZV), (XG, YG, ZG), in order to obtain more accurate position information of the ship, A, V, G three points are merged into one point, which is the S point, here, the invention adopts the following algorithm:
X s = X A + X V + X G 3 Y s = Y A + Y V + Y G 3 Z s = Z A + Z V + Z G 3 - - - ( 8 )
from this, the coordinate of the S point is (X)S,YS,ZS) (ii) a In order to obtain longitude and latitude coordinates, the spatial rectangular coordinates are also converted into geodetic coordinates, and the conversion formula is as follows:
after the processing of the fusion unit, the unique longitude and latitude coordinate S point (B) can be obtainedS,LS,HS). The algorithm effectively improves the accuracy of ship positioning.
After the longitude and latitude coordinates S point of the ship is obtained, the fusion unit sends the coordinates to the monitoring unit, the monitoring unit can be linked with the longitude and latitude coordinates of the ship, for example, the monitoring unit can open a monitoring probe of the longitude and latitude coordinate accessory, the ship is subjected to image capture through the monitoring probe, a video monitoring image of the ship can be obtained, a floating window can be arranged in a monitoring screen and used for displaying the ship image captured in real time, and the rest part of the screen can display the current position of the ship through a map, so that the linkage of the video monitoring and positioning end can be realized.
In order to make the monitoring probe catch the ship, as shown in fig. 4, after the position information of the S point is obtained, the horizontal distance a between the camera and the S point can be obtained1Distance b between camera and ground1As is known, according to the right-angled triangle pythagorean theorem:
c = a 1 2 + b 1 2 - - - ( 10 )
the distance c between the camera and the S point can be obtained, so that the CCTV can adjust the focal length of the camera according to the position information. According to the right-angle surface, the depression angle alpha of the camera can be determined as follows:
α = arcsin a 1 c - - - ( 11 )
for better positioning of the camera, the true Azimuth (Azimuth) of the point S relative to the camera, i.e. the horizontal angle from the true north line to the target line in the clockwise direction from the point, is also determined.
In order to obtain the true azimuth, the patent adopts a station center horizontal coordinate system to calculate the true azimuth. Setting the position of the camera as M point, the earth of the point is seatedIs marked as (B)M,LM,HM) Converted into space rectangular coordinates, i.e. (X), by the coordinate conversion formulaM,YM,ZM). As shown in fig. 5, the coordinate system of the M point is the station center rectangular coordinate system and is denoted as M-NEU. From the above, knowing the spatial rectangular coordinates of the M and S points, from the translational and rotational relationship between the two coordinate systems, we can obtain:
wherein,
R 1 = 1 0 0 0 - 1 0 0 0 1 - - - ( 16 )
the coordinates (N, E, U) of point S in the station-centric horizon coordinate system at point M can thus be found:
N E U = - sinB M cosL M - sinL M sinB M cosB M - sinL M cosL M 0 cosB M cosL M cosB M sinL M sinB M * X S - X M Y S - Y M Z S - Z M - - - ( 17 )
the azimuth angle from point M to point S is: theta as arctan (E/N) (18)
The azimuth is defined as the true azimuth. According to the true azimuth angle theta, the camera can adjust the position of the camera on the horizontal plane, and therefore the monitoring unit can accurately obtain relevant information of the ship.
Example 2
Referring to fig. 6, the present invention further provides a ship positioning method, which includes the following steps: s100: acquiring a plurality of position information of a ship from a plurality of different positioning ends; s200: sequencing the acquired position information according to priority, and sending the position information with the priority greater than a set threshold to a fusion unit; s300: fusing a plurality of position information with the priority greater than a set threshold value to obtain a unique ship longitude and latitude coordinate; s400: and acquiring a ship monitoring image according to the longitude and latitude coordinates of the ship.
Further, the position information includes the current longitude and latitude of the ship, the time of acquiring the position information, and the identifier of the positioning end. The sorting the acquired position information according to the priority includes: subtracting the current time from the time of the ship position information acquired by each positioning end to obtain the time length of the position information sent by each positioning end from the current time, and sequencing the position information according to the priority sequence of the time lengths from small to large.
In summary, in order to obtain accurate position information of a ship, the unique longitude and latitude of the ship are determined through a fusion algorithm, after the position information is obtained, a camera is adjusted, a depression angle α of the camera can be obtained through calculation, then a station center horizon coordinate system is established, and the purpose is to obtain a true azimuth angle θ of the ship relative to the camera, so that after the camera is adjusted through the depression angle α and the horizontal angle θ, relevant information of the ship can be accurately and efficiently obtained.
In the previous description, numerous specific details were set forth in order to provide a thorough understanding of the present invention. The foregoing description is only a preferred embodiment of the invention, which can be embodied in many different forms than described herein, and therefore the invention is not limited to the specific embodiments disclosed above. And that those skilled in the art may, using the methods and techniques disclosed above, make numerous possible variations and modifications to the disclosed embodiments, or modify equivalents thereof, without departing from the scope of the claimed embodiments. Any simple modification, equivalent change and modification of the above embodiments according to the technical essence of the present invention are within the scope of the technical solution of the present invention.

Claims (8)

1. A vessel positioning system, comprising:
the positioning device comprises a position information acquisition unit, a positioning unit and a positioning unit, wherein the position information acquisition unit is used for acquiring a plurality of position information of a ship from a plurality of different positioning ends;
the sorting unit is used for sorting the acquired position information according to priority and sending the position information with the priority greater than a set threshold value to the fusion unit;
the fusion unit is used for fusing a plurality of position information with the priority level larger than a set threshold value to obtain a unique ship longitude and latitude coordinate;
the monitoring unit is used for acquiring a ship monitoring image according to the longitude and latitude coordinates of a ship;
the sorting of the acquired position information according to priority includes: subtracting the current time from the time of the ship position information acquired by each positioning end to obtain the time length of the position information sent by each positioning end from the current time, and sequencing the position information according to the priority sequence of the time lengths from small to large.
2. The system according to claim 1, wherein the position information includes a longitude and latitude where the ship is currently located, a time when the position information is obtained, and a positioning terminal identifier.
3. The vessel positioning system of claim 1, wherein the plurality of distinct positioning ends comprises: AIS, RFID, VITS, satellite positioning, and/or radar.
4. The system according to claim 1, wherein the fusing the plurality of position information with priorities greater than the set threshold to obtain the unique longitude and latitude coordinates of the ship comprises: at the current moment t, the real position of the ship at the moment is set as PtBefore time t, the position coordinates in the position information with the priority greater than the set threshold areLet A, V, G be the three coordinates corresponding to three points respectively, and the vector velocity beAnd are respectively distant from time tCalculating the reference position of the ship at the time t according to the coordinates and the vector speedWherein:
and (B) point A:
point V:
and point G:
using the earth as a reference system, calculating A, V, G reference center and earth coordinates corresponding to the three points as (B)A,LA,HA)、(BV,LV,HV)、(BG,LG,HG) The coordinate system takes the center of a reference ellipsoid as a coordinate origin, and the short axis of the ellipsoid is superposed with the rotating axis of the reference ellipsoid; b is the geodetic latitude, which is the included angle between the normal of the ellipsoid passing through the ground point and the equatorial plane of the ellipsoid; l is the earth longitude, and is the included angle between the ellipsoid meridian plane passing through the ground point and the initial meridian plane; h is the height of the ground;
converting geodetic coordinates into space rectangular coordinates, wherein the conversion formula is as follows:
in a space rectangular coordinate system, 1) taking a reference center O as a coordinate origin; 2) the Z axis coincides with the short axis of the reference ellipsoid; 3) the X axis is superposed with the intersection line of the initial meridian plane and the equator; 4) the Y axis is vertical to the X axis on the equatorial plane to form a right-hand rectangular coordinate system O-XYZ; in the formula (4), N is the curvature radius of the ellipsoidal unitary-ground ring, e is the first eccentricity of the ellipsoid, the long and short radii of the ellipsoids a and b, and W is the first auxiliary coefficient; wherein: a is 6378.137 km; b is 6356.7523141 km;
N = a W - - - ( 5 )
the coordinates of the A, V, G points are substituted into the formulas (5) - (7), and the spatial rectangular coordinates corresponding to A, V, G are calculated to be (X)A,YA,ZA)、(XV,YV,ZV)、(XG,YG,ZG) (ii) a Fusing A, V, G points into one point, making the point be the S point, the algorithm is as follows:
X s = X A + X V + X G 3 Y s = Y A + Y V + Y G 3 Z s = Z A + Z V + Z G 3 - - - ( 8 )
thereby the device is provided withObtain the coordinate of the S point as (X)S,YS,ZS) (ii) a In order to obtain longitude and latitude coordinates, the space rectangular coordinates are converted into geodetic coordinates, and the conversion formula is as follows:
after the processing of the fusion unit, the unique longitude and latitude coordinate S point is obtained as (B)S,LS,HS)。
5. The system according to claim 4, wherein the system for obtaining the ship monitoring image according to the longitude and latitude coordinates of the ship specifically comprises: setting the obtained longitude and latitude coordinates of the ship as an S point, and obtaining the horizontal distance a between the camera and the S point1Distance b between camera and ground1As is known, according to the right-angled triangle pythagorean theorem:
c = a 1 2 + b 1 2 - - - ( 10 )
the distance c between the camera and the point S is obtained, so that the focal length of the camera is adjusted, and according to the right-angle surface, the depression angle alpha of the camera can be determined to be:
α = arcsin a 1 c - - - ( 11 )
then, the true azimuth angle of the point S relative to the camera is calculated, namely, the horizontal included angle between the line from the true north direction line of a certain point to the target direction line along the clockwise direction is calculated, and the true azimuth angle is calculated by adopting a station-centered horizontal coordinate system; position of cameraIs M point, the geodetic coordinate of the point is (B)M,LM,HM) Converted into spatial rectangular coordinates, i.e. (X), by the coordinate conversion formula (4) described aboveM,YM,ZM) Taking a coordinate system where the M point is located as a station center rectangular coordinate system and recording as M-NEU, knowing spatial rectangular coordinates of the M point and the S point, and obtaining the following results according to the translation and rotation relationship between the two coordinate systems:
wherein,
R 1 = 1 0 0 0 - 1 0 0 0 1 - - - ( 16 )
thus, the coordinates (N, E, U) of point S in the station-centric horizontal coordinate system at point M are found:
N E U = - sinB M cosL M - sinL M sinB M cosB M - sinL M cosL M 0 cosB M cosL M cosB M sinL M sinB M * X S - X M Y S - Y M Z S - Z M - - - ( 17 )
the azimuth angle from point M to point S is: theta as arctan (E/N) (18)
And adjusting the position of the camera according to the true azimuth angle theta.
6. A ship positioning method is characterized by comprising the following steps:
s100: acquiring a plurality of position information of a ship from a plurality of different positioning ends;
s200: sequencing the acquired position information according to priority, and sending the position information with the priority greater than a set threshold to a fusion unit;
s300: fusing a plurality of position information with the priority greater than a set threshold value to obtain a unique ship longitude and latitude coordinate;
s400: acquiring a ship monitoring image according to the longitude and latitude coordinates of a ship;
wherein, the step S200 specifically includes: subtracting the current time from the time of the ship position information acquired by each positioning end to obtain the time length of the position information sent by each positioning end from the current time, and sequencing the position information according to the priority sequence of the time lengths from small to large.
7. The ship positioning method according to claim 6, wherein the position information includes a longitude and latitude where the ship is currently located, a time when the position information is obtained, and a positioning terminal identifier.
8. The method of claim 6, wherein the plurality of different positioning ends comprises: AIS, RFID, VITS, satellite positioning, and/or radar.
CN201510593166.3A 2015-09-17 2015-09-17 Ship-positioning system and method Expired - Fee Related CN105180943B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510593166.3A CN105180943B (en) 2015-09-17 2015-09-17 Ship-positioning system and method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510593166.3A CN105180943B (en) 2015-09-17 2015-09-17 Ship-positioning system and method

Publications (2)

Publication Number Publication Date
CN105180943A CN105180943A (en) 2015-12-23
CN105180943B true CN105180943B (en) 2016-08-17

Family

ID=54903194

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510593166.3A Expired - Fee Related CN105180943B (en) 2015-09-17 2015-09-17 Ship-positioning system and method

Country Status (1)

Country Link
CN (1) CN105180943B (en)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106991267A (en) * 2016-01-21 2017-07-28 中国石油化工股份有限公司 Well localization method based on earth ellipsoid
CN106372552B (en) * 2016-08-29 2019-03-26 北京理工大学 Human body target recognition positioning method
CN107270888B (en) * 2017-06-20 2020-11-17 歌尔科技有限公司 Method and device for measuring longitude and latitude and camera
CN108196278B (en) * 2017-12-20 2021-06-15 北京遥感设备研究所 Pointing method based on two-point GPS positioning
CN108761443A (en) * 2018-04-03 2018-11-06 北京环境特性研究所 A kind of method of the longitude and latitude of determining target being observed and a kind of observation platform
CN109729317B (en) * 2019-01-07 2020-11-10 高新兴科技集团股份有限公司 Device for machine linkage of 1+ N cameras
CN109729316B (en) * 2019-01-07 2020-11-10 高新兴科技集团股份有限公司 Method for linking 1+ N cameras and computer storage medium
CN112987710A (en) * 2019-11-29 2021-06-18 深圳市大富科技股份有限公司 Navigation server, AGV, navigation system and navigation method
CN113112540B (en) * 2021-04-09 2024-03-29 东南大学 Method for positioning ship image target by using AIS (automatic identification system) Calibration CCTV (CCTV) camera in VTS (video tape server) system
CN113377255B (en) * 2021-07-05 2024-03-05 中煤航测遥感集团有限公司 Geological disaster slippage azimuth processing method and device and electronic equipment
CN114066860B (en) * 2021-11-19 2024-07-02 东南大学 Ship image target positioning method based on multi-camera combined double-difference calculation
CN117347990A (en) * 2023-10-18 2024-01-05 青岛杰瑞自动化有限公司 Radar-based offshore positioning enhancement method and system and electronic equipment

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101487894A (en) * 2009-02-12 2009-07-22 中山大学 Video positioning service system based on RFID
CN101762805A (en) * 2008-07-02 2010-06-30 凹凸电子(武汉)有限公司 Integrated navigation system and navigation method
CN102034367A (en) * 2010-12-24 2011-04-27 吴安新 System for identifying and positioning ships, and identification and positioning method thereof
CN104854428A (en) * 2013-12-10 2015-08-19 深圳市大疆创新科技有限公司 Sensor fusion

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090058723A1 (en) * 2007-09-04 2009-03-05 Mediatek Inc. Positioning system and method thereof

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101762805A (en) * 2008-07-02 2010-06-30 凹凸电子(武汉)有限公司 Integrated navigation system and navigation method
CN101487894A (en) * 2009-02-12 2009-07-22 中山大学 Video positioning service system based on RFID
CN102034367A (en) * 2010-12-24 2011-04-27 吴安新 System for identifying and positioning ships, and identification and positioning method thereof
CN104854428A (en) * 2013-12-10 2015-08-19 深圳市大疆创新科技有限公司 Sensor fusion

Also Published As

Publication number Publication date
CN105180943A (en) 2015-12-23

Similar Documents

Publication Publication Date Title
CN105180943B (en) Ship-positioning system and method
KR102049371B1 (en) Vessel Auxiliary Docking Method and System
US10378905B2 (en) Auxiliary berthing method and system for vessel
US9507028B1 (en) Positioning apparatus and method for vehicle
KR101334804B1 (en) Integration method of satellite information and ship information for integrated ship monitoring
CN105700547B (en) A kind of aerial three-dimensional video-frequency streetscape system and implementation method based on navigation dirigible
WO2020020086A1 (en) System and method for identifying correctness of angle and distance between orientation of vehicle and road
US20110050903A1 (en) Method for determining position and orientation of vehicle trailers
JP2009188980A (en) Stereo camera having 360 degree field of view
JP2007232690A (en) Present position detection apparatus, map display device and present position detecting method
CN108387206A (en) A kind of carrier three-dimensional attitude acquisition method based on horizon and polarised light
JP2008051745A (en) Mobile locating program, storage medium recording the same, mobile locating device, and mobile locating method
CN109345599A (en) A kind of coordinate transformation method and system of ground coordinate and Pan/Tilt/Zoom camera
CN110889380A (en) Ship identification method and device and computer storage medium
CN101685100A (en) Shooting device for detecting moving speed of shot object and method thereof
US6879284B2 (en) Method and apparatus for identifying objects
CN113296133A (en) Device and method for realizing position calibration based on binocular vision measurement and high-precision positioning fusion technology
JP2010014491A (en) Offshore monitoring system method
US20100085467A1 (en) Image pickup device capable of providing gps coordinates of subject to be shot and method for detecting gps coordinates thereof
KR20100060472A (en) Apparatus and method for recongnizing position using camera
JP5920807B2 (en) Optical axis direction identification method, optical axis direction identification device, and optical axis direction identification program
CN113253619B (en) Ship data information processing method and device
KR20150019085A (en) Position Measuring System and the Method
JP7345153B2 (en) Geographical coordinate estimation device, geographic coordinate estimation system, geographic coordinate estimation method, and computer program for flying objects
CN114500719B (en) Mobile phone with celestial body positioning function and celestial body positioning method

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
CB02 Change of applicant information

Address after: 210000, 687, Zhujianglu Road, Xuanwu District, Jiangsu, Nanjing, 2

Applicant after: JIANGSU ZHONGDA DONGBO INFORMATION SCIENCE & TECHNOLOGY Co.,Ltd.

Address before: 210000 Jiangsu Province, Nanjing city Jiangning District Mo Zhou Road No. 9

Applicant before: NANJING ZHONGDA DONGBO INFORMATION TECHNOLOGY CO.,LTD.

COR Change of bibliographic data
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20160817

CF01 Termination of patent right due to non-payment of annual fee