CN102589549A - Three-station direction-measuring cross-positioning and tracking algorithm in earth coordinate system space - Google Patents
Three-station direction-measuring cross-positioning and tracking algorithm in earth coordinate system space Download PDFInfo
- Publication number
- CN102589549A CN102589549A CN2011104616930A CN201110461693A CN102589549A CN 102589549 A CN102589549 A CN 102589549A CN 2011104616930 A CN2011104616930 A CN 2011104616930A CN 201110461693 A CN201110461693 A CN 201110461693A CN 102589549 A CN102589549 A CN 102589549A
- Authority
- CN
- China
- Prior art keywords
- target
- research
- positioning
- prime
- algorithm flow
- 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
Links
Images
Abstract
The invention discloses an algorithm flow for pure-direction-measuring cross-positioning and tracking in an earth coordinate system space by using three observation stations. By adoption of the algorithm flow, a plurality of movement targets can be subjected to pure-direction-measuring cross-positioning and tracking in the earth coordinate system space by using the three observation stations, and the problems of small area range, low accuracy in positioning and tracking and overlarge calculated quantity of the conventional method can be solved. The algorithm flow is technically characterized in that: (1) the algorithm flow has an idea of positioning the three observation stations, calculating coordinates of the three observation stations, measuring the directions of each target opposite to the three observation stations, determining direction planes where the observation stations and the targets are located, and intersecting three different direction planes for the same target, wherein the coordinate of an intersection point is the position of the target; (2) the algorithm formula derivation process is given; and (3) on the basis of the algorithm idea and a formula, a centralized cross-positioning and tracking algorithm flow and a distributed cross-positioning and tracking algorithm flow are given. The algorithm flow is applicable to quick and accurate positioning and tracking of a plurality of movement targets and has an important practical value for military use and civil use.
Description
Affiliated technical field
The present invention is a kind of method that in the terrestrial coordinate system space, through three station direction findings intersections multiple mobile object is positioned and follows the tracks of.
Background technology
The extremely attention of Chinese scholars and relevant departments always of passive direction finding cross bearing and tracking technique owing to have advantage such as antijamming capability is strong, good concealment.The application of direction finding location technology is of long duration, and exactly the plane that is approximately in a certain zone, utilizes the method for plane geometry to carry out cross bearing calculating then, and not far when target range, this method was simple and effective when scope of activities was little.But continuous development along with technology; The continuous expansion of the scope of activities of the various land, sea and air vehicles; Movement velocity is more and more faster, and it is more and more obvious that the influence of earth curvature just becomes, and the error that this localization method causes has begun in application, to cause serious problems.
In theory in conversion through terrestrial coordinates and geocentric rectangular coordinate; Add the angle of pitch just can be in geocentric rectangular coordinate be the space localizing objects; Can convert terrestrial coordinates into then, thereby but realize cross bearing at too poor interception angle, two stations and the angle of pitch of can't in rectangular coordinate system, carrying out of the angle of pitch precision of the target that obtains through microwave, infrared radiation.
If research station and target being observed all are positioned at research station and the definite aximuthpiston of observed azimuth in fact; As long as all not parallel mutually or coplane of three aximuthpistons at three research stations and same target being observed place, then three aximuthpistons just have and have only an intersection point.Calculate this intersecting point coordinate with method of geometry and can obtain the target location.
Do not find also that from domestic and international disclosed document using this method carries out the correlative study report that the location is handed over again in simple direction finding.
Summary of the invention
Suppose three research station S on the earth
A(φ
A, λ
A, h
A) or (x
A, y
A, z
A) (being respectively the coordinate in earth coordinates and the space geocentric rectangular coordinate system), S
B(φ
B, λ
B, h
B) or (x
B, y
B, z
B), S
C(φ
C, λ
C, h
C) or (x
C, y
C, z
C), a target T
1, T
1Respectively at S
A, S
BAnd S
CPosition angle in sky, the local northeast rectangular coordinate system is α
A1, α
B1And α
C1
Through a S
AThe meridian equation do
Wherein, W=(1-e
2Sin
2φ
A)
1/2,-pi/2≤φ
A≤pi/2
λ rotates around the z axle in system with the space geocentric rectangular coordinate
AThe angle obtains new coordinate system X ' Y ' Z ', some S
ACoordinate under new coordinate system does
Through S
AThe expression formula of this meridian tangential equation on coordinate system X ' Y ' Z ' do
The angle of this tangent line and X ' axle does
Get
Therefore, some S
ASky, the northeast rectangular coordinate system at place can be regarded as by space the earth rectangular coordinate system XYZ elder generation initial point motionless, around Z axle rotation λ
AThe angle is then around Y axle rotation θ
AThe angle moves to a S then
AThe place, the coordinate conversion expression formula of this process does
In coordinate system X ' Y ' Z ', target T
1Just through X ' axle and with plane X ' Z ' angle be α
A1The plane on, note is made plane X ' S
AT
1, face X ' S might as well make even
AT
1Last two vectors of conllinear not
According to (6), these two vectors in the expression mode of former rectangular coordinate system XYZ kind do
So plane (S
A, e
A11, e
A12) expression formula can be written as
Ax+By+Cz+D=0 (11)
Here it is research station S
AWith to target T
1Observed bearing α
A1Determined azimuth plane.
Wherein,
D=-(Ax
A+By
A+Cz
A) (15)
In like manner, research station S
BWith to target T
1Observed bearing α
B1Determined azimuth plane (S
B, e
B11, e
B12) expression formula do
A′x+B′y+C′z+D′=0 (16)
Research station S
BWith to target T
1Observed bearing α
B1Determined azimuth plane (S
B, e
B11, e
B12) expression formula do
A″x+B″y+C″z+D″=0 (17)
Wherein,
D′=-(A′x
B+B′y
B+C′z
B) (21)
D″=-(A″x
B+B″y
B+C″z
B) (29)
So target T
1Coordinate satisfy system of equations
Formula (34) can be written as matrix equation
Further be written as
If determinant of coefficient D (36) ≠ 0, then it has unique solution
A wherein
Ij=(1)
I+jM
IjBe called (i, j) first a
IjAlgebraic complement, M
IjBe (i, j) first a
IjAfter the capable and j of the i row at place are scratched, the 2 rank determinants that stay.
Obtain target T by (37)
1Coordinate (x, y z), convert terrestrial coordinate (φ into
1, λ
1, h
1)
h
1=(k-1)N (50)
Description of drawings
Accompanying drawing 1 algorithm basic thought process flow diagram
S
A, S
BAnd S
CBe three direction finding platforms, T
1Be measured target, T
1Respectively at S
A, S
BAnd S
CPosition angle in sky, the local northeast rectangular coordinate system is α
A1, α
B1And α
C1S
AAnd α
A1, S
Bα
B1, S
CAnd α
C1The intersection point of the azimuth plane of confirming respectively is exactly target T
1The position of point.
The algorithm flow that accompanying drawing 2 centralized cross bearings are followed the tracks of
1. the position of three research stations in measuring between earth-based coordinate system;
2. these three research stations record the relative direction of target respectively;
3. the position of these three research stations and the relative direction that records target thereof are pooled to concentrator in real time with the network message form;
4. respectively with the position of each research station and record each observation station of direction calculating of target and the aximuthpiston at target place;
5. the intersecting point coordinate that is directed against three aximuthpistons of same target is the target location.
The algorithm flow that accompanying drawing 3 distributed cross bearings are followed the tracks of
1. the position of three research stations in measuring between earth-based coordinate system;
2. these three research stations record the relative direction of target respectively;
3. separately the research station according to own position and record this point of direction calculating of target and the aximuthpiston that target belongs to;
4. be pooled to concentrator through each research station and target direction face parameter in real time with the network message form;
5. the intersecting point coordinate that is directed against three aximuthpistons of same target is the target location.
Embodiment
The present invention has designed to utilize through the earth great circle of two research stations, the face of land and has carried out two kinds of algorithm flows that cross bearing is followed the tracks of: the algorithm flow that algorithm flow that centralized cross bearing is followed the tracks of and distributed cross bearing are followed the tracks of.
(1) algorithm flow of centralized cross bearing tracking is shown in accompanying drawing 2:
1. the position of three research stations in measuring between earth-based coordinate system;
2. these three research stations record the relative direction of target respectively;
3. the position of these three research stations and the relative direction that records target thereof are pooled to concentrator in real time with the network message form;
4. respectively with the position of each research station and record each observation station of direction calculating of target and the aximuthpiston at target place;
5. the intersecting point coordinate that is directed against three aximuthpistons of same target is the target location.
(2) algorithm flow of distributed cross bearing tracking is shown in accompanying drawing 3:
1. the position of three research stations in measuring between earth-based coordinate system;
2. these three research stations record the relative direction of target respectively;
3. separately the research station according to own position and record this point of direction calculating of target and the aximuthpiston that target belongs to;
4. be pooled to concentrator through each research station and target direction face parameter in real time with the network message form;
5. the intersecting point coordinate that is directed against three aximuthpistons of same target is the target location.
Claims (4)
1. the present invention has provided and in the terrestrial coordinate system space, has utilized three simple direction findings in research station to carry out algorithm thought and derivation of equation process that cross bearing is followed the tracks of.Two kinds of algorithm flows have been designed: the algorithm flow that algorithm flow that centralized cross bearing is followed the tracks of and distributed cross bearing are followed the tracks of.
2. the general technical characteristic of algorithm thought and derivation of equation process:
The coordinate of three research stations of location Calculation itself; Obtain the orientation of relative three research stations of target respectively through direction finding; Confirm the aximuthpiston at research station and target place, can intersect at a point that this intersecting point coordinate is the target location to three of same target different aximuthpistons.
3. the technical characterictic of the algorithm flow that centralized cross bearing is followed the tracks of:
1. the position of three research stations in measuring between earth-based coordinate system;
2. these three research stations record the relative direction of target respectively;
3. the position of these three research stations and the relative direction that records target thereof are pooled to concentrator in real time with the network message form;
4. respectively with the position of each research station and record each observation station of direction calculating of target and the aximuthpiston at target place;
5. the intersecting point coordinate that is directed against three aximuthpistons of same target is the target location.
4. the technical characterictic of the algorithm flow that distributed cross bearing is followed the tracks of:
1. the position of three research stations in measuring between earth-based coordinate system;
2. these three research stations record the relative direction of target respectively;
3. separately the research station according to own position and record this point of direction calculating of target and the aximuthpiston that target belongs to;
4. be pooled to concentrator through each research station and target direction face parameter in real time with the network message form;
5. the intersecting point coordinate that is directed against three aximuthpistons of same target is the target location.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110461693.0A CN102589549B (en) | 2011-12-22 | 2011-12-22 | Three station direction cross positioning track algorithm in terrestrial coordinate system space |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110461693.0A CN102589549B (en) | 2011-12-22 | 2011-12-22 | Three station direction cross positioning track algorithm in terrestrial coordinate system space |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102589549A true CN102589549A (en) | 2012-07-18 |
CN102589549B CN102589549B (en) | 2017-09-29 |
Family
ID=46478536
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110461693.0A Expired - Fee Related CN102589549B (en) | 2011-12-22 | 2011-12-22 | Three station direction cross positioning track algorithm in terrestrial coordinate system space |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102589549B (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109916406A (en) * | 2019-01-10 | 2019-06-21 | 浙江大学 | A kind of circular object localization method based on unmanned aerial vehicle group |
CN110954055A (en) * | 2019-12-17 | 2020-04-03 | 中国人民解放军海军航空大学 | Spherical surface two-station direction finding cross positioning calculation method |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4346384A (en) * | 1980-06-30 | 1982-08-24 | The Austin Company | Remote object position and orientation locator |
JPH07280568A (en) * | 1994-04-14 | 1995-10-27 | Takao Yamaguchi | Coordinate converter |
CN1477406A (en) * | 2003-06-12 | 2004-02-25 | 上海交通大学 | Double-platform multiple radiation source direction-measuring time-measuring cross-positioning method |
US20040107072A1 (en) * | 2002-12-03 | 2004-06-03 | Arne Dietrich | Ins-based user orientation and navigation |
CN101013036A (en) * | 2007-02-07 | 2007-08-08 | 北京航空航天大学 | Photoelectric detection system based ground vehicle accurate positioning orientation method |
CN101308206A (en) * | 2008-07-11 | 2008-11-19 | 北京航空航天大学 | Circumferential track mobile target tracking method under white noise background |
RU2381964C1 (en) * | 2008-07-31 | 2010-02-20 | Открытое акционерное общество "Раменское приборостроительное конструкторское бюро" | Moving object orientation metre |
CN101709973A (en) * | 2009-11-26 | 2010-05-19 | 哈尔滨工业大学 | Large-scale formation relative navigation method |
-
2011
- 2011-12-22 CN CN201110461693.0A patent/CN102589549B/en not_active Expired - Fee Related
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4346384A (en) * | 1980-06-30 | 1982-08-24 | The Austin Company | Remote object position and orientation locator |
JPH07280568A (en) * | 1994-04-14 | 1995-10-27 | Takao Yamaguchi | Coordinate converter |
US20040107072A1 (en) * | 2002-12-03 | 2004-06-03 | Arne Dietrich | Ins-based user orientation and navigation |
CN1477406A (en) * | 2003-06-12 | 2004-02-25 | 上海交通大学 | Double-platform multiple radiation source direction-measuring time-measuring cross-positioning method |
CN101013036A (en) * | 2007-02-07 | 2007-08-08 | 北京航空航天大学 | Photoelectric detection system based ground vehicle accurate positioning orientation method |
CN101308206A (en) * | 2008-07-11 | 2008-11-19 | 北京航空航天大学 | Circumferential track mobile target tracking method under white noise background |
RU2381964C1 (en) * | 2008-07-31 | 2010-02-20 | Открытое акционерное общество "Раменское приборостроительное конструкторское бюро" | Moving object orientation metre |
CN101709973A (en) * | 2009-11-26 | 2010-05-19 | 哈尔滨工业大学 | Large-scale formation relative navigation method |
Non-Patent Citations (9)
Title |
---|
修建娟等: "多目标纯方位定位和跟踪", 《现代雷达》 * |
修建娟等: "被动定位系统中的方位数据关联", 《系统工程与电子技术》, vol. 25, no. 3, 31 December 2003 (2003-12-31) * |
刘兰石等: "三角交叉无源定位位置偏差估计滤波算法研究", 《系统工程与电子技术》, vol. 22, no. 12, 31 December 2000 (2000-12-31) * |
孔博等: "基于Singer模型的机动目标无源定位跟踪方法研究", 《电光与控制》, vol. 18, no. 5, 31 May 2011 (2011-05-31) * |
孙仲康等: "《单多基地有源无源定位技术》", 31 May 1996 * |
徐敬等: "基于测向交叉和卡尔曼滤波的多舰无源被动定位算法", 《现代雷达》 * |
王成等: "长基线测向交叉被动定位算法坐标变换误差的研究", 《系统工程与电子技术》, vol. 24, no. 2, 31 December 2002 (2002-12-31) * |
陈锋莉等: "基于交会角的多站交叉定位融合算法及误差仿真", 《火力与指挥控制》, vol. 35, no. 5, 31 May 2010 (2010-05-31) * |
马登峰: "多目标辐射源无源定位技术研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109916406A (en) * | 2019-01-10 | 2019-06-21 | 浙江大学 | A kind of circular object localization method based on unmanned aerial vehicle group |
CN109916406B (en) * | 2019-01-10 | 2020-10-13 | 浙江大学 | Surrounding target positioning method based on unmanned aerial vehicle cluster |
CN110954055A (en) * | 2019-12-17 | 2020-04-03 | 中国人民解放军海军航空大学 | Spherical surface two-station direction finding cross positioning calculation method |
Also Published As
Publication number | Publication date |
---|---|
CN102589549B (en) | 2017-09-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103744052B (en) | A kind of double star being applied to aerial target location surveys time-of-arrival direction finding method and device | |
CN109613583B (en) | Passive target positioning method based on single star and ground station direction finding and combined time difference | |
CN108061889A (en) | AIS and the correlating method of radar angular system deviation | |
CN103674029B (en) | A kind of method of many ships collaborative navigation formation configuration based on underwater sound communication | |
CN103927744B (en) | Method for dividing agility satellite observation object strip based on pointing postures | |
CN103293512A (en) | Positioning using a local wave-propagation model | |
CN106446422A (en) | Log likelihood estimation based novel passive locating and tracking method | |
CN102591343A (en) | Satellite orbit maintenance and control method based on two lines of radicals | |
CN104348539A (en) | Satellite communication point wave beam covering region calculation method | |
CN104390646A (en) | Position matching method for underwater vehicle terrain aided inertial navigation system | |
Li et al. | Optimal deployment of vehicles with circular formation for bearings-only multi-target localization | |
CN102607560A (en) | Two-station direction-finding cross positioning tracing algorithm on earth surface based on rhumb lines | |
CN101907461B (en) | Measuration data correlation method for passive multisensor based on angle cotangent value | |
CN102176163B (en) | Determining method of task observation duration | |
CN105300373A (en) | Three-dimensional coordinate conversion method and device | |
CN104239678A (en) | Method and device for implementing direction finding and positioning of interferometer | |
CN104237862A (en) | Probability hypothesis density filter radar system error fusion estimation method based on ADS-B | |
CN107782317A (en) | A kind of unidirectional navigation locating method of deep space of falling VLBI | |
CN102589549A (en) | Three-station direction-measuring cross-positioning and tracking algorithm in earth coordinate system space | |
CN104199024A (en) | Target positioning method based on optical measurement of very short base line | |
CN104391311B (en) | Passive location method on star based on GPS broadcast datas | |
CN102589548B (en) | Two-station direction finding cross-localization tracing algorithm based on large circle on earth surface | |
CN104330078B (en) | Combined measuring method based on three-point resection model | |
CN115793002A (en) | Double-satellite combined passive positioning method based on direction finding error weight | |
CN104535990B (en) | Bistatic radar receiving and sending beam three-dimensional synchronization method based on coordinate transformation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170929 Termination date: 20211222 |
|
CF01 | Termination of patent right due to non-payment of annual fee |