发明名称 |
一种火箭橇轨道重力实时测量方法 |
摘要 |
一种火箭橇轨道重力实时测量方法(1)在当前导航周期,根据火箭橇轨道中的纬度与高度信息的关系,得到当前导航周期下真实的火箭橇橇体高度信息h<sub>B</sub>,进而得到高度误差信号δh=h-h<sub>B</sub>;(2)将高度误差信号δh经过积分控制得到控制分量x,高度误差信号δh经过PID控制,得到高度控制量u<sub>h</sub>;(3)将分量x经过低通滤波得到重力偏差x′,再将重力偏差x′与地球重力模型值g<sub>h</sub>做和,得到实时的测量重力值g<sub>0</sub>;(4)将u<sub>h</sub>及g<sub>0</sub>反馈至惯性导航系统,由惯性导航系统解算得到修正后的火箭橇橇体的高度h;(5)进入下一导航周期,惯性导航系统解算火箭橇橇体的纬度信息,根据火箭橇轨道中的纬度与高度信息的关系,得到当前导航周期下真实的h<sub>B</sub>,重新得到高度误差信号δh;转步骤(2)循环执行。 |
申请公布号 |
CN103955005A |
申请公布日期 |
2014.07.30 |
申请号 |
CN201410198469.0 |
申请日期 |
2014.05.12 |
申请人 |
北京航天控制仪器研究所 |
发明人 |
魏宗康;赵龙;刘璠 |
分类号 |
G01V7/16(2006.01)I;G01C21/18(2006.01)I;G01C25/00(2006.01)I |
主分类号 |
G01V7/16(2006.01)I |
代理机构 |
中国航天科技专利中心 11009 |
代理人 |
庞静 |
主权项 |
一种火箭橇轨道重力实时测量方法,其特征在于步骤如下:(1)在当前导航周期,惯性导航系统解算火箭橇撬体的高度h以及火箭橇橇体的纬度信息,根据火箭橇轨道中的纬度与高度信息的关系,得到当前导航周期下真实的火箭橇橇体高度信息h<sub>B</sub>,进而得到高度误差信号δh=h‑h<sub>B</sub>;所述的惯性导航系统置于火箭橇橇体中;(2)将高度误差信号δh经过积分控制得到控制分量x,高度误差信号δh经过PID控制,得到高度控制量u<sub>h</sub>;(3)将上述控制分量x经过低通滤波得到重力偏差x′,再将重力偏差x′与地球重力模型值g<sub>h</sub>做和,得到实时的测量重力值g<sub>0</sub>;(4)将步骤(2)中得到的高度控制量u<sub>h</sub>以及步骤(3)中得到实时的测量重力值g<sub>0</sub>反馈至惯性导航系统,由惯性导航系统解算得到修正后的火箭橇撬体的高度h;(5)进入下一导航周期,惯性导航系统解算火箭橇橇体的纬度信息,根据火箭橇轨道中的纬度与高度信息的关系,得到当前导航周期下真实的火箭橇橇体高度信息h<sub>B</sub>,将步骤(4)中修正后的高度h与h<sub>B</sub>做差,得到高度误差信号δh;转步骤(2)循环执行。 |
地址 |
100854 北京市海淀区142信箱403分箱 |