[發(fā)明專利]一種基于兩點(diǎn)GPS定位的指向方法

有效

• 申請(qǐng)?zhí)枺?/td>: 201711385320.3
• 申請(qǐng)日: 2017-12-20
• 公開(kāi)（公告）號(hào): CN108196278B
• 公開(kāi)（公告）日: 2021-06-15
• 發(fā)明（設(shè)計(jì)）人: 何靖
• 申請(qǐng)（專利權(quán)）人: 北京遙感設(shè)備研究所
• 主分類號(hào): G01S19/39
• 分類號(hào): G01S19/39
• 代理公司: 中國(guó)航天科工集團(tuán)公司專利中心 11024
• 代理人: 孔曉芳

1.一種基于兩點(diǎn)GPS定位的指向方法，其特征在于具體步驟為：

第一步搭建指向系統(tǒng)

指向系統(tǒng)，包括：GPS定位模塊(1)、坐標(biāo)系轉(zhuǎn)換模塊(2)、定位點(diǎn)位置關(guān)系差分模塊(3)、坐標(biāo)旋轉(zhuǎn)模塊(4)和指向模塊(5)；

所述GPS定位模塊(1)在GPS定位芯片中運(yùn)行；坐標(biāo)系轉(zhuǎn)換模塊(2)、定位點(diǎn)位置關(guān)系差分模塊(3)、坐標(biāo)旋轉(zhuǎn)模塊(4)和指向模塊(5)在主機(jī)芯片中運(yùn)行；

第二步GPS定位模塊(1)根據(jù)導(dǎo)航衛(wèi)星信息獲得當(dāng)前位置的定位信息P(φ,λ,h)，定位點(diǎn)一的定位信息P₁(φ₁,λ₁,h₁),定位點(diǎn)二的定位信息P₂(φ₂,λ₂,h₂)；

其中φ表示大地維度，λ表示大地經(jīng)度，h大地高度；

第三步坐標(biāo)系轉(zhuǎn)換模塊(2)將GPS大地坐標(biāo)變換到地心地固坐標(biāo)，得到P₁(x₁,y₁,z₁)、P₂(x₂,y₂,z₂)

x＝(N+h)·cosφ·cosλ

y＝(N+h)·cosφ·sinλ

z＝[N·(1-e²)+h]·sinφ

其中N是基準(zhǔn)橢球體的卯酉圓曲率半徑，e為橢球偏心率

第四步定位點(diǎn)位置關(guān)系差分模塊(3)根據(jù)定位信息計(jì)算兩點(diǎn)位置的差分向量的具體過(guò)程為：

根據(jù)公式

得到兩點(diǎn)位置的差分向量表示：ΔP(Δx，Δy，Δz)；

第五步坐標(biāo)旋轉(zhuǎn)模塊(4)將差分向量轉(zhuǎn)換為站心向量的具體過(guò)程為：

坐標(biāo)旋轉(zhuǎn)模塊(4)將差分向量轉(zhuǎn)換為以P₁為原點(diǎn)的站心向量P^*

第六步指向模塊(5)根據(jù)站心向量P^*計(jì)算方向角度α

以正北為0°，北向順時(shí)針旋轉(zhuǎn)為正，逆時(shí)針旋轉(zhuǎn)為負(fù)；

至此實(shí)現(xiàn)了基于兩點(diǎn)GPS定位的指向方法。