CN112325841B - 一种动中通天线安装误差角的估计方法 - Google Patents
一种动中通天线安装误差角的估计方法 Download PDFInfo
- Publication number
- CN112325841B CN112325841B CN202011153273.1A CN202011153273A CN112325841B CN 112325841 B CN112325841 B CN 112325841B CN 202011153273 A CN202011153273 A CN 202011153273A CN 112325841 B CN112325841 B CN 112325841B
- Authority
- CN
- China
- Prior art keywords
- angle
- antenna
- matrix
- error
- attitude
- 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.)
- Active
Links
- 238000009434 installation Methods 0.000 title claims abstract description 46
- 238000000034 method Methods 0.000 title claims abstract description 15
- 238000005259 measurement Methods 0.000 claims abstract description 28
- 230000009466 transformation Effects 0.000 claims abstract description 12
- 238000001914 filtration Methods 0.000 claims abstract description 6
- 239000011159 matrix material Substances 0.000 claims description 33
- 238000005096 rolling process Methods 0.000 claims description 5
- 238000005516 engineering process Methods 0.000 claims description 4
- 238000010276 construction Methods 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 238000004422 calculation algorithm Methods 0.000 abstract description 8
- 238000004891 communication Methods 0.000 abstract description 5
- 230000005540 biological transmission Effects 0.000 abstract 1
- 238000004364 calculation method Methods 0.000 description 2
- 239000000969 carrier Substances 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C1/00—Measuring angles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Manufacturing & Machinery (AREA)
- Variable-Direction Aerials And Aerial Arrays (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种动中通天线安装误差角的估计方法,属于卫星通信以及测控技术领域。该方法通过在动中通天线的方位旋转平台上安装惯性测量单元,使用天线安装载体上导航设备的输出信息作为外部观测信息,建立适用于任意安装误差角的传递对准算法模型,估计出天线安装平面的安装误差角,同时对惯性测量单元的捷联导航算法结果进行误差补偿。本发明通过将天线安装载体上的导航设备进行旋转变换,克服了使用Kalman滤波进行姿态匹配传递对准时的小角度误差要求,具有实施简单、适用范围广的优点。
Description
技术领域
本发明属于卫星通信以及测控技术领域,特别是指一种动中通天线安装误差角的估计方法。该方法可应用于动中通天线,用来测量天线安装面与天线安装载体之间的安装误差角。
背景技术
在卫星通信以及测控领域的在多数应用场合要求实现对天线指向的精确测量和控制。特别地,在车载、船载和机载等动中通卫星通信等领域,大部分的天线安装载体都有较为精确的惯性导航***等导航设备,用于测量载体的航姿信息,同时提供给天线,用于补偿载体运动时造成的指向角度偏差。
现有技术中,天线使用载体的航姿信息时,姿态信息反映的是天线安装载体的空间状态,其与天线安装平面的姿态之间存在固定的安装误差。为了测定这些误差,需要使用专门的标校方法,而现有的标校方法大都比较复杂,实施起来较为繁琐。
发明内容
本发明的目的在于提供一种动中通天线安装误差角的估计方法,该方法通过在动中通天线的方位旋转平台上安装惯性测量单元,使用天线安装载体上导航设备的输出信息作为外部观测信息,建立适用于任意安装误差角的传递对准算法模型,估计出天线安装平面的安装误差角,同时对惯性测量单元的捷联导航算法结果进行误差补偿。
为了实现上述目的,本发明采用的技术方案为:
一种动中通天线安装误差角的估计方法,包括以下步骤:
(1)采集天线的方位转动角、天线上安装的随天线方位转动的惯性测量单元输出的角速度和比力数据,得到天线安装平面的航姿数据;
(2)将天线安装载体上的导航设备的航姿数据与天线安装平面的航姿数据进行比较,若某一项数据相差超过3°,则将载体上导航设备的航姿数据进行坐标变换,以满足小角度误差模型;
(3)建立含安装误差角的状态空间,以及含速度误差、小角度姿态角误差的观测模型,使用传递对准技术对安装误差角进行估计。
进一步的,所述步骤(1)的具体方式为:
(101)建立天线和惯性测量单元的坐标系;
(102)采集惯性测量单元的陀螺仪输出的角速度数据ωx、ωy、ωz,以及惯性测量单元的加速度计输出的比力数据fx、fy、fz,计算出天线当前位置的俯仰角θ和横滚角γ,并将航向角ψ置0;
(103)将天线对准卫星,根据步骤(102)中的俯仰角θ和横滚角γ以及卫星的空间位置,反解出真实航向角ψ;
(104)根据步骤(102)获得的俯仰角θ、横滚角γ以及步骤(103)获得的航向角ψ,计算出姿态矩阵将其右乘由天线方位转动角Aj得到的转换矩阵得到天线安装平面的姿态矩阵进而计算出天线安装平面的航向角俯仰角横滚角
进一步的,所述步骤(2)的具体方式为:
[ψj θj γj]=[ψm θm γm]
其中,
进一步的,所述步骤(3)的具体方式为:
(301)采用Kalman滤波器作为传递对准滤波器,建立***状态方程:
其中,A(t)为状态转移矩阵,W(t)为噪声矩阵,上标·表示求导;***状态向量其中Δv=[Δve Δvn Δvu]分别为东向、北向、天向速度误差,φ=[φe φn φu]分别为东向、北向、天向失准角,ε=[εx εy εz]分别为X轴、Y轴、Z轴方向的陀螺零偏,分别为X轴、Y轴、Z轴方向的加速度计零偏,λ=[λx λy λz]分别为X轴、Y轴、Z轴方向的安装误差角;
其中,I为单位矩阵,H(t)为观测矩阵,V(t)为观测噪声矩阵,×表示反对称矩阵,ZDCMx、ZDCMy、ZDCMz分别为ZDCM的x、y、z分量;
(303)将Kalman滤波估计得到的安装误差角λ,按下式变换后得到实际的安装误差角λx、λy、λz:
本发明采用上述技术方案的有益效果在于:
a)使用算法对安装误差角进行估计,不需要设计专用的精密测量面来放置水平仪,也不需要精确安装望远镜等光学瞄准装置并在天线面开孔构建光学瞄准通道。
b)不需要对天线的安装误差进行标校,由算法自动完成,不需人工干预,降低了天线的调试和安装的工作量。
c)通过将天线安装载体上的导航设备进行旋转变换,克服了使用Kalman滤波进行姿态匹配传递对准时的小角度误差要求。
d)适应性好,与天线座架的结构形式无关。
附图说明
图1是本发明实施例中动中通天线以天线安装载体上的导航设备的安装示意图。
图2是本发明实施例方法的流程图。
具体实施方式
下面结合附图和具体实施方式对本发明的技术方案做进一步的详细说明。
一种动中通天线安装误差角的估计方法,如图2所示,其包括以下步骤:
(1)采集天线的方位转动角、天线上安装的随天线方位转动的惯性测量单元输出的角速度和比力数据,得到天线安装平面的航姿数据;
(2)将天线安装载体上的导航设备的航姿数据与天线安装平面的航姿数据进行比较,若某一项数据相差超过3°,则将载体上导航设备的航姿数据进行坐标变换,以满足小角度误差模型;
(3)建立含安装误差角的状态空间,以及含速度误差、小角度姿态角误差的观测模型,使用传递对准技术对安装误差角进行估计。
本方法中的天线如图1所示,其包括天线面1、方位电机4,其中位置2和位置3均可安装惯性测量单元。
其中,步骤(1)的具体方式为:
(101)建立天线和惯性测量单元的坐标系:天线坐标系以天线的重心为坐标原点O,过坐标原点O且指向天线安装载体前进方向为Y轴正方向,过坐标原点O且垂直于天线安装载体纵切面指向所述载体右侧为X轴正方向,过坐标原点O垂直于X轴和Y轴所在平面且指向所述载体上方为Z轴正方向,建立三轴坐标系;如图1所示,在位置2和位置3中任选一处安装自主惯性测量单元,以自主惯性测量单元中心为原点O,其X轴、Y轴、Z轴分别与天线坐标系的X轴、Y轴、Z轴平行;
(102)采集惯性测量单元的陀螺仪输出ωx、ωy、ωz,加速度计输出fx、fy、fz,计算出天线当前位置的俯仰角θ和横滚角γ,航向角ψ置0,以此为初值进行纯惯性航姿解算;
(103)天线对准卫星,根据当前时刻俯仰角θ、横滚角γ和卫星的空间位置,反解出真实航向角ψ;
步骤(2)的具体方式为:
[ψj θj γj]=[ψm θm γm]
(202)若|Δψ|、|Δθ|、|Δγ|中存在不小于3°的值,则将载体上导航设备的航姿数据按下式进行坐标变换,以减小二者之间的差值[Δψ Δθ Δγ]。
其中,
步骤(3)的具体方式为:
(301)采用Kalman卡尔曼滤波器作为传递对准滤波器,建立***状态方程:
其中,A(t)为状态转移矩阵,W(t)为噪声矩阵,上标·表示求导;***状态向量其中Δv=[Δve Δvn Δvu]分别为东向、北向、天向速度误差,φ=[φe φn φu]分别为东向、北向、天向失准角,ε=[εx εy εz]分别为X轴、Y轴、Z轴方向的陀螺零偏,分别为X轴、Y轴、Z轴方向的加速度计零偏,λ=[λx λy λz]分别为X轴、Y轴、Z轴方向的安装误差角;
其中,I为单位矩阵,H(t)为观测矩阵,V(t)为观测噪声矩阵,×表示反对称矩阵,ZDCMx、ZDCMy、ZDCMz分别为ZDCM的x、y、z分量;
(303)将Kalman滤波估计得到的安装误差角λ,按下式变换后得到实际的安装误差角λx、λy、λz:
该方法通过在动中通天线的方位旋转平台上安装惯性测量单元,使用天线安装载体上导航设备的输出信息作为外部观测信息,建立基于速度姿态匹配模式的、适用于任意安装误差角的传递对准算法模型,估计出天线安装平面的安装误差角,同时对惯性测量单元的捷联导航算法结果进行误差补偿。
总之,本发明应用传递对准技术估计动中通天线的非小角度安装误差角,其通过将天线安装载体上的导航设备进行旋转变换,克服了使用Kalman滤波进行姿态匹配传递对准时的小角度误差要求,具有实施简单、适用范围广的优点。
Claims (1)
1.一种动中通天线安装误差角的估计方法,其特征在于,包括以下步骤:
(1)采集天线的方位转动角、天线上安装的随天线方位转动的惯性测量单元输出的角速度和比力数据,得到天线安装平面的航姿数据;具体方式为:
(101)建立天线和惯性测量单元的坐标系;
(102)采集惯性测量单元的陀螺仪输出的角速度数据ωx、ωy、ωz,以及惯性测量单元的加速度计输出的比力数据fx、fy、fz,计算出天线当前位置的俯仰角θ和横滚角γ,并将航向角ψ置0;
(103)将天线对准卫星,根据步骤(102)中的俯仰角θ和横滚角γ以及卫星的空间位置,反解出真实航向角ψ;
(104)根据步骤(102)获得的俯仰角θ、横滚角γ以及步骤(103)获得的航向角ψ,计算出姿态矩阵将其右乘由天线方位转动角Aj得到的转换矩阵得到天线安装平面的姿态矩阵进而计算出天线安装平面的航向角俯仰角横滚角
(2)将天线安装载体上的导航设备的航姿数据与天线安装平面的航姿数据进行比较,若某一项数据相差超过3°,则将载体上导航设备的航姿数据进行坐标变换,以满足小角度误差模型;具体方式为:
其中,
(3)建立含安装误差角的状态空间,以及含速度误差、小角度姿态角误差的观测模型,使用传递对准技术对安装误差角进行估计;具体方式为:
(301)采用Kalman滤波器作为传递对准滤波器,建立***状态方程:
其中,A(t)为状态转移矩阵,W(t)为噪声矩阵,上标·表示求导;***状态向量其中Δv=[Δve Δvn Δvu]分别为东向、北向、天向速度误差,φ=[φe φn φu]分别为东向、北向、天向失准角,ε=[εx εy εz]分别为X轴、Y轴、Z轴方向的陀螺零偏,分别为X轴、Y轴、Z轴方向的加速度计零偏,λ=[λx λy λz]分别为X轴、Y轴、Z轴方向的安装误差角;
其中,I为单位矩阵,H(t)为观测矩阵,V(t)为观测噪声矩阵,×表示反对称矩阵,ZDCMx、ZDCMy、ZDCMz分别为ZDCM的x、y、z分量;
(303)将Kalman滤波估计得到的安装误差角λ,按下式变换后得到实际的安装误差角λx、λy、λz:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011153273.1A CN112325841B (zh) | 2020-10-26 | 2020-10-26 | 一种动中通天线安装误差角的估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011153273.1A CN112325841B (zh) | 2020-10-26 | 2020-10-26 | 一种动中通天线安装误差角的估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112325841A CN112325841A (zh) | 2021-02-05 |
CN112325841B true CN112325841B (zh) | 2022-05-27 |
Family
ID=74310666
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011153273.1A Active CN112325841B (zh) | 2020-10-26 | 2020-10-26 | 一种动中通天线安装误差角的估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112325841B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113237456B (zh) * | 2021-05-31 | 2022-10-28 | 西南电子技术研究所(中国电子科技集团公司第十研究所) | 动中通天线初始安装角测量方法 |
CN114543795B (zh) * | 2021-12-31 | 2024-01-02 | 文远苏行(江苏)科技有限公司 | 双天线航向角的安装误差估计方法和调整方法及相关设备 |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3579807A (en) * | 1968-05-29 | 1971-05-25 | Leonard A Matulewicz | Method and apparatus for producing a stream feeder |
CN101089764A (zh) * | 2006-06-13 | 2007-12-19 | 中国科学院空间科学与应用研究中心 | 一种天线自动跟踪对星控制装置和控制方法 |
US7400956B1 (en) * | 2003-03-20 | 2008-07-15 | Hemisphere Gps Inc. | Satellite position and heading sensor for vehicle steering control |
CN101505002A (zh) * | 2009-03-17 | 2009-08-12 | 重庆航天新世纪卫星应用技术有限责任公司 | 快恢复型动中通的动中对星方法 |
JP2009265335A (ja) * | 2008-04-24 | 2009-11-12 | Sony Corp | 駆動制御装置、駆動制御方法及びプログラム |
CN101833080A (zh) * | 2009-03-12 | 2010-09-15 | 周迅 | 一种利用gps***附加约束条件的载体姿态测量方法 |
CN104064869A (zh) * | 2014-06-13 | 2014-09-24 | 北京航天控制仪器研究所 | 基于mems惯导的双四元数动中通天线控制方法及*** |
CN105466456A (zh) * | 2015-12-22 | 2016-04-06 | 中国电子科技集团公司第五十四研究所 | 动中通天线稳定陀螺动态消除零点漂移的方法 |
CN108845500A (zh) * | 2018-07-11 | 2018-11-20 | 中国电子科技集团公司第五十四研究所 | 一种动中通天线扰动观测补偿控制方法 |
CN109443385A (zh) * | 2018-11-13 | 2019-03-08 | 中国兵器装备集团自动化研究所 | 一种动中通天线的惯导安装误差自动标定方法 |
CN110926468A (zh) * | 2019-12-05 | 2020-03-27 | 中国电子科技集团公司第五十四研究所 | 基于传递对准的动中通天线多平台航姿确定方法 |
CN111006660A (zh) * | 2019-12-11 | 2020-04-14 | 陕西瑞特测控技术有限公司 | 一种组合惯导姿态计算方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7509216B2 (en) * | 2004-03-29 | 2009-03-24 | Northrop Grumman Corporation | Inertial navigation system error correction |
-
2020
- 2020-10-26 CN CN202011153273.1A patent/CN112325841B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3579807A (en) * | 1968-05-29 | 1971-05-25 | Leonard A Matulewicz | Method and apparatus for producing a stream feeder |
US7400956B1 (en) * | 2003-03-20 | 2008-07-15 | Hemisphere Gps Inc. | Satellite position and heading sensor for vehicle steering control |
CN101089764A (zh) * | 2006-06-13 | 2007-12-19 | 中国科学院空间科学与应用研究中心 | 一种天线自动跟踪对星控制装置和控制方法 |
JP2009265335A (ja) * | 2008-04-24 | 2009-11-12 | Sony Corp | 駆動制御装置、駆動制御方法及びプログラム |
CN101833080A (zh) * | 2009-03-12 | 2010-09-15 | 周迅 | 一种利用gps***附加约束条件的载体姿态测量方法 |
CN101505002A (zh) * | 2009-03-17 | 2009-08-12 | 重庆航天新世纪卫星应用技术有限责任公司 | 快恢复型动中通的动中对星方法 |
CN104064869A (zh) * | 2014-06-13 | 2014-09-24 | 北京航天控制仪器研究所 | 基于mems惯导的双四元数动中通天线控制方法及*** |
CN105466456A (zh) * | 2015-12-22 | 2016-04-06 | 中国电子科技集团公司第五十四研究所 | 动中通天线稳定陀螺动态消除零点漂移的方法 |
CN108845500A (zh) * | 2018-07-11 | 2018-11-20 | 中国电子科技集团公司第五十四研究所 | 一种动中通天线扰动观测补偿控制方法 |
CN109443385A (zh) * | 2018-11-13 | 2019-03-08 | 中国兵器装备集团自动化研究所 | 一种动中通天线的惯导安装误差自动标定方法 |
CN110926468A (zh) * | 2019-12-05 | 2020-03-27 | 中国电子科技集团公司第五十四研究所 | 基于传递对准的动中通天线多平台航姿确定方法 |
CN111006660A (zh) * | 2019-12-11 | 2020-04-14 | 陕西瑞特测控技术有限公司 | 一种组合惯导姿态计算方法 |
Non-Patent Citations (6)
Title |
---|
Low-Cost Antenna Attitude Estimation by Fusing Inertial Sensing and Two-Antenna GPS for Vehicle-Mounted Satcom-on-the-Move;Zongwei Wu等;《 IEEE Transactions on Vehicular Technology》;20121121;第62卷(第3期);第1084-1096页 * |
Qin Liping 等.Algorithm for angle measurement in multi-planar antenna SOTM tracking.《Electronics Optics & Control》.2009,第16卷(第6期), * |
低成本小口径动中通天线航姿参考***设计;秦超;《河北省科学院学报》;20180930;第35卷(第3期);第30-34页 * |
动中通天线与载体惯导的安装误差估计方法;秦超 等;《无线电通信技术》;20181031;第44卷(第6期);第632-636页 * |
用于微捷联惯导***的传递对准技术研究;孔星炜;《中国优秀博硕士学位论文全文数据库(博士)工程科技Ⅱ辑》;20130930(第9期);第2.6.1节 * |
秦超等.基于滤波估计的传递对准观测值延时抑制方法.《河北省科学院学报》.2019,(第04期), * |
Also Published As
Publication number | Publication date |
---|---|
CN112325841A (zh) | 2021-02-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110926468B (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN106289246B (zh) | 一种基于位置和姿态测量***的柔性杆臂测量方法 | |
CN110398257B (zh) | Gps辅助的sins***快速动基座初始对准方法 | |
CN100516775C (zh) | 一种捷联惯性导航***初始姿态确定方法 | |
CN102608596B (zh) | 一种用于机载惯性/多普勒雷达组合导航***的信息融合方法 | |
CN107270893B (zh) | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 | |
CN101949703B (zh) | 一种捷联惯性/卫星组合导航滤波方法 | |
CN102519470B (zh) | 多级嵌入式组合导航***及导航方法 | |
CN106052686B (zh) | 基于dsptms320f28335的全自主捷联惯性导航*** | |
CN110954102B (zh) | 用于机器人定位的磁力计辅助惯性导航***及方法 | |
CN104236586B (zh) | 基于量测失准角的动基座传递对准方法 | |
CN102288133B (zh) | 一种陀螺间接稳定***安装偏角标定方法 | |
CN112325841B (zh) | 一种动中通天线安装误差角的估计方法 | |
CN106767925B (zh) | 带双轴转位机构的惯导***三位置参数辨识对准方法 | |
CN110887505A (zh) | 一种冗余式惯性测量单元实验室标定方法 | |
CN115773751B (zh) | 一种修正等效天向加计零位造成对准误差的方法 | |
CN108303120B (zh) | 一种机载分布式pos的实时传递对准的方法及装置 | |
CN105115505A (zh) | 一种四轴惯性稳定平台***的二阶动态干扰力矩补偿方法 | |
CN113008229B (zh) | 一种基于低成本车载传感器的分布式自主组合导航方法 | |
CN112284412B (zh) | 一种避免欧拉转换奇异导致精度下降的地面静态对准方法 | |
CN112798014A (zh) | 一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法 | |
CN115727842B (zh) | 一种无人机快速对准方法、***、计算机设备及存储介质 | |
CN114061574B (zh) | 一种基于位置不变约束及零速校正的采煤机定姿定向方法 | |
CN112833910A (zh) | 惯性测量单元的水平安装偏差角标定方法、设备及介质 | |
CN110779551A (zh) | 一种基于加性四元数的两阶段线性对准在线切换方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |