CN105180943B - Ship-positioning system and method - Google Patents
Ship-positioning system and method Download PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims description 13
- 238000012544 monitoring process Methods 0.000 claims abstract description 26
- 238000012163 sequencing technique Methods 0.000 claims abstract description 16
- 230000004927 fusion Effects 0.000 claims description 20
- 101100221616 Halobacterium salinarum (strain ATCC 29341 / DSM 671 / R1) cosB gene Proteins 0.000 claims description 9
- 238000006243 chemical reaction Methods 0.000 claims description 9
- 238000012545 processing Methods 0.000 claims description 3
- 238000013519 translation Methods 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 239000000523 sample Substances 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000001679 citrus red 2 Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/203—Specially 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
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;
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:
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:
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:
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,
thus, the coordinates (N, E, U) of point S in the station-centric horizontal coordinate system at point M are found:
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;
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:
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:
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:
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,
the coordinates (N, E, U) of point S in the station-centric horizon coordinate system at point M can thus be found:
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;
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:
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:
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:
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,
thus, the coordinates (N, E, U) of point S in the station-centric horizontal coordinate system at point M are found:
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.
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)
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)
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)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090058723A1 (en) * | 2007-09-04 | 2009-03-05 | Mediatek Inc. | Positioning system and method thereof |
-
2015
- 2015-09-17 CN CN201510593166.3A patent/CN105180943B/en not_active Expired - Fee Related
Patent Citations (4)
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 |