发明名称 一种载体加速运动时倾角误差修正方法
摘要 本发明提出一种载体加速运动时倾角误差修正方法,在天线处于稳定跟踪状态下,根据计算得到的天线载体直线加速度和向心加速度在姿态测量单元倾角传感器敏感方向上的分量,对直线加速度和向心加速度对倾角传感器的影响进行修正,然后对修正后倾角传感器角速度数据做卡尔曼滤波处理,得到修正后的横滚、俯仰倾角。本发明通过对倾角传感器的横滚倾角以及俯仰倾角进行修正,克服了载体加速度对倾角传感器的影响。通过修正后的横滚倾角以及俯仰倾角,能够准确控制姿态测量单元的传感器安装面水平,保证了天线电轴对卫星的跟踪精度。而且本发明运算量小,实现方便,不需要增加额外的硬件电路。采用本发明的方法后,天线一旦进入稳定跟踪状态,不易丢失目标。
申请公布号 CN106123927A 申请公布日期 2016.11.16
申请号 CN201610728235.1 申请日期 2016.08.25
申请人 西安坤蓝电子技术有限公司 发明人 张勇;苏有道;李寒;谢宏;谢治许;王芳;甄学军
分类号 G01C25/00(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 西北工业大学专利中心 61204 代理人 陈星
主权项 一种载体加速运动时倾角误差修正方法,其特征在于:当AEC座架天线处于对卫星准确对准状态时,AEC座架天线的姿态测量单元方位角等于天线理论方位角H,姿态测量单元传感器安装面的俯仰角和横滚角等于0;采用以下步骤计算倾角误差并修正:步骤1:根据AEC座架天线的全球卫星定位系统给出的航向、速度数据,计算AEC座架天线载体的直线加速度α<sub>t</sub>和向心加速度α<sub>n</sub>:α<sub>t</sub>=(V<sub>n</sub>‑V<sub>n‑1</sub>)/ΔTα<sub>n</sub>=[(H<sub>n</sub>‑H<sub>n‑1</sub>)/ΔT]V<sub>n</sub>其中V<sub>n</sub>和V<sub>n‑1</sub>为第n次以及第n‑1次对全球卫星定位系统采样得到的速度,H<sub>n</sub>和H<sub>n‑1</sub>为第n次以及第n‑1次对全球卫星定位系统采样得到的航向角,ΔT为采样时间间隔;步骤2:计算AEC座架天线载体的直线加速度α<sub>t</sub>和向心加速度α<sub>n</sub>在姿态测量单元横滚和俯仰倾角传感器敏感方向上的分量a<sub>c</sub>=α<sub>n</sub>sin(H‑H<sub>n</sub>)‑α<sub>t</sub>cos(H‑H<sub>n</sub>)a<sub>e</sub>=α<sub>n</sub>cos(H‑H<sub>n</sub>)+α<sub>t</sub>sin(H‑H<sub>n</sub>)其中a<sub>c</sub>为加速度在横滚倾角传感器敏感方向的分量,a<sub>e</sub>为加速度在俯仰倾角传感器敏感方向的分量,H为天线理论方位角;步骤3:使用加速度横滚方向分量a<sub>c</sub>和加速度俯仰方向分量a<sub>e</sub>,计算横滚和俯仰倾角传感器敏感方向相对水平面的倾斜角:Θ<sub>c</sub>=sin<sup>‑1</sup>((A<sub>c</sub>‑a<sub>c</sub>)/g)Θ<sub>e</sub>=sin<sup>‑1</sup>((A<sub>e</sub>‑a<sub>e</sub>)/g)其中Θ<sub>c</sub>为横滚倾角传感器敏感方向相对水平面的倾角,Θ<sub>e</sub>为俯仰倾角传感器敏感方向相对水平面的倾角,A<sub>c</sub>为横滚倾角传感器敏感方向比力测量值,A<sub>e</sub>为俯仰倾角传感器敏感方向比力测量值,g为重力加速度;步骤4:对步骤3得到的倾角传感器敏感方向相对水平面的横滚倾角Θ<sub>c</sub>以及姿态测量单元横滚轴角速率陀螺进行卡尔曼滤波,得到修正后的横滚倾角;对步骤3得到的倾角传感器敏感方向相对水平面的俯仰倾角Θ<sub>e</sub>以及姿态测量单元俯仰轴角速率陀螺进行卡尔曼滤波,得到修正后的俯仰倾角。
地址 710068 陕西省西安市友谊西路446号
您可能感兴趣的专利