CN107918139A - 一种角速度辅助的Kalman滤波定位方法 - Google Patents
一种角速度辅助的Kalman滤波定位方法 Download PDFInfo
- Publication number
- CN107918139A CN107918139A CN201610905124.3A CN201610905124A CN107918139A CN 107918139 A CN107918139 A CN 107918139A CN 201610905124 A CN201610905124 A CN 201610905124A CN 107918139 A CN107918139 A CN 107918139A
- Authority
- CN
- China
- Prior art keywords
- mtd
- mrow
- msub
- mtr
- satellite
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
一种角速度辅助的Kalman滤波定位方法,包括如下步骤:步骤1、捕获卫星信号,解调导航电文,剔除故障卫星;步骤2、解算运动载体的初始状态变量、方位角、角速度、方差;步骤3、确定采用的Kalman滤波方程模型,根据不同载体类型和不同的接收机类型确定各个参数的值:步骤4、检测接收卫星信息是否良好,若是,直接利用Kalman方程解算出当前时刻的状态变量‑位置、速度和加速度;当接收卫星信息不好,不能利用卫星信息进行卫星定位时,确定现时刻的载体的所在方位,联合Kalman滤波的预测方程,两者进行等权计算现时刻状态解算载体的位置、速度等信息。本发明在卫星定位失败时,能够显著提高没有惯性传感器等辅助手段情况下的动态定位精度。
Description
技术领域
本发明涉及卫星导航定位的技术领域,特别涉及一种角速度辅助的Kalman滤波定位方法。
背景技术
随着中国北斗卫星系统的发展,目前国内已经打破了GPS独大的局面,相应的卫星导航定位相关产品也多以双模或多模的形式出现。其中应用较为广泛便是北斗+GPS双模动态定位。
卫星动态定位的精度主要依靠于接收的卫星信息、定位的算法和辅助信息,由于动态运动的环境复杂性,我们很难改变接收的卫星信息。传统的动态定位一般采用组合导航的模式,即卫星导航定位+惯性传感器,惯性传感器一般可以测得载体的角速度且在卫星导航定位失败的情况下能提供短时间的定位。而对于一般的运动载体而言,也不能苛求它拥有完善的惯性传感器等可以辅助定位的装置,这时候改进定位算法提高定位精度就成了有效的手段。
在没有其他融合的惯性传感器等的辅助下,卫星动态定位会因地理位置不利导致卫星接收不到进而导致定位失败。消除车辆卫星定位随机误差的方法有多种,其中比较常用的方法之一是GPS动态滤波,即利用滤波器消除各种随机误差,从而提高定位精度。一般情况下,多用Kalman滤波算法来提高动态定位的精度,Kalman预测方程实际上是根据上一时刻的位置和速度预测出的一条运动轨迹,又由于动态运动载体的运动复杂性,因此单靠Kalman状态方程预测定位结果精度很难得到保障。但是当卫星信号被严重遮挡或者没有卫星信号时,普通的基于位置、速度、加速度的自适应Kalman滤波的定位精度不高,有待改善。
发明内容
有鉴于此,本发明的目的在于,提供一种角速度辅助的Kalman滤波定位方法,在卫星定位失败的情况下,添加基于角速度的辅助方程,再依据前一时刻的状态值和预测方程一起预测现时刻的状态量(位置、速度),结果表明这种方法行之有效,可以在一定程度上提高卫星定位失败情况下的实际导航定位精度。
本发明的目的是以下述方式实现的:
一种角速度辅助的Kalman滤波定位方法,包括如下步骤:
步骤1、运动载体的接收机捕获并跟踪卫星信号,解调卫星导航电文,剔除故障卫星和异常卫星;
步骤2、利用接收到的前几个历元的卫星信息解算运动载体的初始状态变量X0、方位角S0、角速度Vr0、方差P0;
步骤3、确定采用的Kalman滤波方程模型,假设没有系统控制输入,根据不同载体类型和不同的接收机类型确定以下参数:过程激励噪声协方差矩阵为Q,观测噪声协方差矩阵为R,转换矩阵φ,测量矩阵H,马尔可夫过程在三个坐标轴方向的相关时间常数τx、τy、τz;
取状态变量为X=[x vx ax εx y vy ay εy z vz az εz]T,观测变量Z=[Lx Lvx LyLvy Lz Lvz]T;
其中,分别为X、Y、Z轴上的加速度方差矩阵,分别为X、Y、Z轴上的定位误差方差矩阵;其中(x vx αx)、(y vy αy)、(z vz αz)3组状态变量分别为xyz三个坐标轴上的位置、速度、加速度分量,εx、εy、εz分别为各种误差源在三个坐标轴方向造成的总位置误差,观测变量(Lx Lvx)、(Ly Lvy)、(Lz Lvz)分别为接收机解算出的xyz三个坐标轴上的位置、速度分量;R=diag[Rx Ry Rz],其中Rx、Ry、Rz分别为X、Y、Z轴上的观测噪声协方差分量;
步骤4、根据现时刻接收卫星信息初步解算位置、速度、载体运行方位角,然后根据前一时刻的位置、速度、加速度,利用卡尔曼滤波方程解算现时刻的位置、速度和加速度;
具体包括如下步骤:
步骤401、检测接收卫星信息是否良好以解算当前载体运行方位角,若是,利用如下卡尔曼滤波方程解算当前时刻的状态变量返回退出;若否,转到步骤402;
Kk=P(k,k-1)HT(HP(k,k-1)HT+R)-1
P(k,k-1)=φPk-1φT+Q
Pk=(I-KkH)P(k,k-1)
式中,是利用K-1时刻状态变量预测的K时刻状态变量预测结果,是K-1时刻的状态变量最优结果,是K时刻的状态变量最优估算值,Kk为卡尔曼增益;Pk为后验估计误差的协方差矩阵,P(k,k-1)为先验估计误差的协方差矩阵;
步骤402、将k-1时刻状态变量由XYZ坐标系转换为NEU坐标系,设NEU坐标系下的速度变量为Vn0、Ve0、Vh0:
步骤403、计算添加角速度辅助后的速度变量:
Vn=(Vn0*Vn0+Ve0*Ve0)1/2*cos(Sk-1)
Ve=(Vn0*Vn0+Ve0*Ve0)1/2*sin(Sk-1)
Vh=Vh0
步骤404、;令Vrk-1=Vrk-2,Vrk-1、Vrk-2分别是K-1、K-2时刻的角速度;根据辅助方程角速度:Vrk-1=(Sk-Sk-1)/T计算Sk=Sk-1+Vrk-1*T,Sk是K时刻的载体运行方位角;
步骤405、将NEU坐标系下的速度变量Vn、Ve、Vh转换为XYZ坐标系,设此时XYZ坐标系下的速度变量相应为vx1、vy1、vz1,令
步骤406、联合Kalman滤波方程,两者进行等权计算现时刻状态变量预测结果:
返回退出。
优选地,所述步骤1具体包括如下步骤:
步骤101)接收机天线捕获并跟踪来自卫星的信号,解调出卫星的导航电文,得到卫星位置、钟差以及其他修正参数;
步骤102)根据导航电文的内容和格式来判断校验是否存在误码,剔除掉含有误码的导航电文对应的故障卫星;
步骤103)对跟踪到的可用的卫星的位置和运动轨迹的连续性进行判断卫星导航电文的正确性,剔除掉存在跳变异常的卫星以及载噪比和仰角不满足门限值要求的卫星。
优选地,所述步骤3中,在车载GPS接收机情况下, Rx=Ry=Rz=diag(122,0.22),τx=τy=τz=0.5。
优选地,所述步骤3中,
T为观测时间间隔,
其中Φx、Φy、Φz分别为XYZ三个坐标轴上的转换矩阵。
本申请在卫星定位失败的情况下,添加基于角速度的辅助方程,再依据前一时刻的状态值和预测方程一起预测现时刻的状态量(位置、速度),利用辅助方程代替惯性传感器的功能,在没有融合辅助工具时,在卫星定位失败的情况下,添加的基于角速度的辅助方程的Kalman滤波动态定位一定程度上提高了定位精度,改善了滤波器的动态性能,使其具有一定的跟踪能力,显著提高了在动态定位中没有惯性传感器等辅助手段情况下的动态定位精度。
附图说明
图1为添加角速度辅助方程的Kalman滤波算法的原理示意图。
具体实施方式
如图1所示,本发明提供的角速度辅助的Kalman滤波定位方法,具体包括如下步骤:
(1)首先接收机天线捕获并跟踪来自卫星的信号,解调出卫星的导航电文,得到卫星位置、钟差以及其他修正参数。其次根据导航电文的内容和格式来判断校验是否存在误码,剔除掉含有误码的导航电文对应的故障卫星。最后对跟踪到的可用的卫星的位置和运动轨迹的连续性进行判断卫星导航电文的正确性,剔除掉存在跳变等异常的卫星以及载噪比和仰角不满足门限值要求的卫星。
(2)利用接收到的前几个历元的卫星信息解算运动载体的初始状态变量、方位角S0、角速度Vr0、方差P0。
(3)确定采用的Kalman滤波方程模型,假设没有系统控制输入,根据不同载体类型和不同的接收机类型确定各已知为常数的参数:过程激励噪声协方差矩阵为Q,观测噪声协方差矩阵为R,转换矩阵Φ,测量矩阵H,马尔可夫过程在三个坐标轴方向的相关时间常数τx、τy、τz。取状态变量为X=[x vx ax εx y vy ay εy z vz az εz]T,观测变量Z=[Lx Lvx LyLvy Lz Lvz]T,其中(x vx ax)、(y vy ay)、(z vz az)3组状态变量分别为xyz三个坐标轴上的位置、速度、加速度分量,εx、εy、εz分别为各种误差源在三个坐标轴方向造成的总位置误差,观测变量(Lx Lvx)、(Ly Lvy)、(Lz Lvz)分别为接收机解算出的xyz三个坐标轴上的位置、速度分量。
Q阵为过程激励噪声协方差矩阵:
其中,分别为XYZ轴上的加速度方差矩阵,分别为XYZ轴上的定位误差方差。
R阵为观测噪声协方差矩阵:R=diag[Rx Ry Rz],Rx、Ry、Rz分别为X、Y、Z轴上的观测噪声协方差分量。
实际中,过程激励噪声协方差矩阵Q和观测噪声协方差矩阵R根据不同的载体不同的接收机类型而变化,但同一接收机同一载体运行过程中视为常量。因此不同的载体运行状态和不同的接收机针对不同的各参数取值,一般都是通过大量实验得来的经验值,比如,本专利采用的车载GPS接收机仿真实验中,取Rx=Ry=Rz=diag(122,0.22),τx=τy=τz=0.5,
(T为观测时间间隔)
其中Φx、Φy、Φz分别为XYZ三个坐标轴上的转换矩阵,
(4)根据现时刻接收卫星信息初步解算位置、速度、载体运行方位角,然后根据前一时刻的位置、速度、加速度,利用卡尔曼滤波方程解算现时刻的位置、速度和加速度(扩展卡尔曼滤波算法可参见相关文档,这里不再累述)。具体实现步骤如下:
a)设状态方程:Xk=ΦXk-1+Wk-1
观测方程:Zk=HXk+Vk
式中随机信号Wk和Vk分别表示过程激励噪声和观测噪声,假设它们为相互独立、正态分布的白色噪声:Wk~N(0,Q),Vk~N(0,R)。
卡尔曼滤波模型:
Kk=P(k,k-1)HT(HP(k,k-1)HT+R)-1
P(k,k-1)=ΦPk-1ΦT+Q
Pk=(I-KkH)P(k,k-1)
式中,是利用K-1时刻状态变量预测的K时刻状态变量预测结果,是K-1时刻的状态变量最优结果,是K时刻的状态变量最优估算值,Kk为卡尔曼增益;Pk为后验估计误差的协方差矩阵,P(k,k-1)为先验估计误差的协方差矩阵,Φ为转换矩阵,Q为过程激励噪声协方差矩阵,R为系统的观测噪声方差阵。
辅助方程角速度:Vrk-1=(Sk-Sk-1)/T,(3)
当接收卫星信息不好,不能解算载体运行方位角时,Vrk-1近似等于Vrk-2,因此估算Vrk-1=Vrk-2,Vrk-1、Vrk-2分别是K-1、K-2时刻的角速度;计算K时刻的载体运行方位角Sk=Sk-1+Vrk-1*T,Sk用于K+1时刻接收卫星的速度变量Vn、Ve、Vh计算使用。
将k-1时刻状态变量由XYZ坐标系转换为NEU坐标系,设NEU坐标系下的速度变量为Vn0、Ve0、Vh0:
假设运动存在均角速度运动,则添加角速度辅助后的速度变量变为:
Vn=(Vn0*Vn0+Ve0*Ve0)1/2*cos(Sk-1)
Ve(Vn0*Vn0+Ve0*Ve0)1/2*sin(Sk-1)
Vh=Vh0
再将NEU坐标系下的速度变量Vn、Ve、Vh转换为XYZ坐标系,设此时XYZ坐标系下的速度变量相应为vx1、vy1、vz1,令
b)当接收卫星信息良好,直接利用方程(1)和(2)解算出当前时刻的状态变量-位置、速度和加速度;当接收卫星信息不好,不能利用卫星信息进行卫星定位时,利用辅助方程(4)和(1)联合解算现时刻的状态变量-位置、速度和加速度。
具体联合思想为:利用辅助方程确定现时刻的载体的所在方位,联合Kalman滤波的预测方程,两者进行等权计算现时刻状态解算载体的位置、速度等信息预测结果:
经过仿真测试与实际车载动态试验,定位结果有改善。其中,添加辅助方程的运动轨迹和实际道路更匹配;通过车载动态试验表明,添加了角速度辅助方程后,在载体接收不到卫星信号解算不出当前位置速度观测值时,联合自适应扩展Kalman滤波方程解算的位置比没有添加加速度辅助方程的解算结果精度上有明显的提升。
以上所述的仅是本发明的优选实施方式,应当指出,对于本领域的技术人员来说,在不脱离本发明整体构思前提下,还可以作出若干改变和改进,这些也应该视为本发明的保护范围。
Claims (4)
1.一种角速度辅助的Kalman滤波定位方法,其特征在于:包括如下步骤:
步骤1、运动载体的接收机捕获并跟踪卫星信号,解调卫星导航电文,剔除故障卫星和异常卫星;
步骤2、利用接收到的前几个历元的卫星信息解算运动载体的初始状态变量X0、方位角S0、角速度Vr0、方差P0;
步骤3、确定采用的Kalman滤波方程模型,假设没有系统控制输入,根据不同载体类型和不同的接收机类型确定以下参数:过程激励噪声协方差矩阵为Q,观测噪声协方差矩阵为R,转换矩阵Φ,测量矩阵H,马尔可夫过程在三个坐标轴方向的相关时间常数τx、τy、τz;
取状态变量为X=[x vx αx εx y vy αy εy z vz αz εz]T,观测变量Z=[Lx Lvx Ly Lvy LzLvz]T;
其中,分别为X、Y、Z轴上的加速度方差矩阵,分别为X、Y、Z轴上的定位误差方差矩阵;其中(x vx αx)、(y vy αy)、(z vz αz)3组状态变量分别为xyz三个坐标轴上的位置、速度、加速度分量,εx、εy、εz分别为各种误差源在三个坐标轴方向造成的总位置误差,观测变量(Lx Lvx)、(Ly Lvy)、(Lz Lvz)分别为接收机解算出的xyz三个坐标轴上的位置、速度分量;
R=diag[Rx Ry Rz],其中Rx、Ry、Rz分别为X、Y、Z轴上的观测噪声协方差分量;
步骤4、根据现时刻接收卫星信息初步解算位置、速度、载体运行方位角,然后根据前一时刻的位置、速度、加速度,利用卡尔曼滤波方程解算现时刻的位置、速度和加速度;
具体包括如下步骤:
步骤401、检测接收卫星信息是否良好以解算当前载体运行方位角,若是,利用如下卡尔曼滤波方程解算当前时刻的状态变量返回退出;若否,转到步骤402;
<mrow>
<msub>
<mover>
<mi>X</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>,</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</msub>
<mo>=</mo>
<mi>&Phi;</mi>
<msub>
<mover>
<mi>X</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mover>
<mi>X</mi>
<mo>^</mo>
</mover>
<mi>k</mi>
</msub>
<mo>=</mo>
<msub>
<mover>
<mi>X</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>,</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>K</mi>
<mi>k</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>Z</mi>
<mi>k</mi>
</msub>
<mo>-</mo>
<mi>H</mi>
<msub>
<mover>
<mi>X</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>,</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
Kk=P(k,k-1)HT(HP(k,k-1)HT+R)-1
P(k,k-1)=ΦPk-1ΦT+Q
Pk=(I-KkH)P(k,k-1)
式中,是利用K-1时刻状态变量预测的K时刻状态变量预测结果,是K-1时刻的状态变量最优结果,是K时刻的状态变量最优估算值,Kk为卡尔曼增益;Pk为后验估计误差的协方差矩阵,P(k,k-1)为先验估计误差的协方差矩阵;
步骤402、将k-1时刻状态变量由XYZ坐标系转换为NEU坐标系,设NEU坐标系下的速度变量为Vn0、Ve0、Vh0:
步骤403、计算添加角速度辅助后的速度变量:
Vn=(Vn0*Vn0+Ve0*Ve0)1/2*cos(Sk-1)
Ve=(Vn0*Vn0+Ve0*Ve0)1/2*sin(Sk-1)
Vh=Vh0
步骤404、;令Vrk-1=Vrk-2,Vrk-1、Vrk-2分别是K-1、K-2时刻的角速度;根据辅助方程角速度:Vrk-1=(Sk-Sk-1)/T计算Sk=Sk-1+Vrk-1*T,Sk是K时刻的载体运行方位角;
步骤405、将NEU坐标系下的速度变量Vn、Ve、Vh转换为XYZ坐标系,设此时XYZ坐标系下的速度变量相应为vx1、vy1、vz1,令
步骤406、联合Kalman滤波方程,两者进行等权计算现时刻状态变量预测结果:
返回退出。
2.根据权利要求1所述的角速度辅助的Kalman滤波定位方法,其特征在于:所述步骤1具体包括如下步骤:
步骤101)接收机天线捕获并跟踪来自卫星的信号,解调出卫星的导航电文,得到卫星位置、钟差以及其他修正参数;
步骤102)根据导航电文的内容和格式来判断校验是否存在误码,剔除掉含有误码的导航电文对应的故障卫星;
步骤103)对跟踪到的可用的卫星的位置和运动轨迹的连续性进行判断卫星导航电文的正确性,剔除掉存在跳变异常的卫星以及载噪比和仰角不满足门限值要求的卫星。
3.根据权利要求1所述的角速度辅助的Kalman滤波定位方法,其特征在于:步骤3中,在车载GPS接收机情况下,Rx=Ry=Rz=diag(122,0.22)τx=τy=τz=0.5。
4.根据权利要求1所述的角速度辅助的Kalman滤波定位方法,其特征在于:步骤3中,
<mrow>
<mi>&Phi;</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>&Phi;</mi>
<mi>x</mi>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>&Phi;</mi>
<mi>y</mi>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>&Phi;</mi>
<mi>z</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
T为观测时间间隔,
<mrow>
<msub>
<mi>&Phi;</mi>
<mi>y</mi>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mi>T</mi>
</mtd>
<mtd>
<mrow>
<msup>
<mi>T</mi>
<mn>2</mn>
</msup>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mi>T</mi>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<mfrac>
<mi>T</mi>
<msub>
<mi>&tau;</mi>
<mi>y</mi>
</msub>
</mfrac>
</mrow>
</msup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>&Phi;</mi>
<mi>Z</mi>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mi>T</mi>
</mtd>
<mtd>
<mrow>
<msup>
<mi>T</mi>
<mn>2</mn>
</msup>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mi>T</mi>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<mfrac>
<mi>T</mi>
<msub>
<mi>&tau;</mi>
<mi>z</mi>
</msub>
</mfrac>
</mrow>
</msup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
其中Φx、Φy、Φz:分别为XYZ三个坐标轴上的转换矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610905124.3A CN107918139B (zh) | 2016-10-18 | 2016-10-18 | 一种角速度辅助的Kalman滤波定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610905124.3A CN107918139B (zh) | 2016-10-18 | 2016-10-18 | 一种角速度辅助的Kalman滤波定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107918139A true CN107918139A (zh) | 2018-04-17 |
CN107918139B CN107918139B (zh) | 2021-05-11 |
Family
ID=61892893
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610905124.3A Active CN107918139B (zh) | 2016-10-18 | 2016-10-18 | 一种角速度辅助的Kalman滤波定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107918139B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109742543A (zh) * | 2019-01-29 | 2019-05-10 | 上海微小卫星工程中心 | 一种用于将终端的天线对准卫星的方法及相应系统 |
CN109990789A (zh) * | 2019-03-27 | 2019-07-09 | 广东工业大学 | 一种飞行导航方法、装置及相关设备 |
CN113484890A (zh) * | 2021-08-10 | 2021-10-08 | 深圳市一科时代科技发展有限公司 | 4g全网通自动辅助定位器及其定位方法 |
CN115048621A (zh) * | 2022-07-08 | 2022-09-13 | 北京航天驭星科技有限公司 | 空间飞行器的跟踪测量方法、装置、电子设备及介质 |
CN115201874A (zh) * | 2021-04-09 | 2022-10-18 | 北京六分科技有限公司 | 数据质量监控方法、装置、设备及存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101782391A (zh) * | 2009-06-22 | 2010-07-21 | 北京航空航天大学 | 机动加速度辅助的扩展卡尔曼滤波航姿系统姿态估计方法 |
JP2011122921A (ja) * | 2009-12-10 | 2011-06-23 | Mitsubishi Electric Corp | 位置標定装置、位置標定方法、位置標定プログラム、速度ベクトル算出装置、速度ベクトル算出方法および速度ベクトル算出プログラム |
CN102680997A (zh) * | 2012-05-31 | 2012-09-19 | 东南大学 | 磁导航辅助gps/ins组合导航定位系统及其控制方法 |
CN103557871A (zh) * | 2013-10-22 | 2014-02-05 | 北京航空航天大学 | 一种浮空飞行器捷联惯导空中初始对准方法 |
-
2016
- 2016-10-18 CN CN201610905124.3A patent/CN107918139B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101782391A (zh) * | 2009-06-22 | 2010-07-21 | 北京航空航天大学 | 机动加速度辅助的扩展卡尔曼滤波航姿系统姿态估计方法 |
JP2011122921A (ja) * | 2009-12-10 | 2011-06-23 | Mitsubishi Electric Corp | 位置標定装置、位置標定方法、位置標定プログラム、速度ベクトル算出装置、速度ベクトル算出方法および速度ベクトル算出プログラム |
CN102680997A (zh) * | 2012-05-31 | 2012-09-19 | 东南大学 | 磁导航辅助gps/ins组合导航定位系统及其控制方法 |
CN103557871A (zh) * | 2013-10-22 | 2014-02-05 | 北京航空航天大学 | 一种浮空飞行器捷联惯导空中初始对准方法 |
Non-Patent Citations (2)
Title |
---|
MAHSA AKHBARI ET AL.: "ECG denoising using angular velocity as a state and an observation in an Extended Kalman Filter framework", 《2012 ANNUAL INTERNATIONAL CONFERENCE OF THE IEEE ENGINEERING IN MEDICINE AND BIOLOGY SOCIETY》 * |
张国栋 等: "一种引入距变率和角变率的卡尔曼滤波算法", 《舰船电子工程》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109742543A (zh) * | 2019-01-29 | 2019-05-10 | 上海微小卫星工程中心 | 一种用于将终端的天线对准卫星的方法及相应系统 |
CN109742543B (zh) * | 2019-01-29 | 2021-07-23 | 上海微小卫星工程中心 | 一种用于将终端的天线对准卫星的方法及相应系统 |
CN109990789A (zh) * | 2019-03-27 | 2019-07-09 | 广东工业大学 | 一种飞行导航方法、装置及相关设备 |
CN115201874A (zh) * | 2021-04-09 | 2022-10-18 | 北京六分科技有限公司 | 数据质量监控方法、装置、设备及存储介质 |
CN115201874B (zh) * | 2021-04-09 | 2024-02-23 | 北京六分科技有限公司 | 数据质量监控方法、装置、设备及存储介质 |
CN113484890A (zh) * | 2021-08-10 | 2021-10-08 | 深圳市一科时代科技发展有限公司 | 4g全网通自动辅助定位器及其定位方法 |
CN115048621A (zh) * | 2022-07-08 | 2022-09-13 | 北京航天驭星科技有限公司 | 空间飞行器的跟踪测量方法、装置、电子设备及介质 |
CN115048621B (zh) * | 2022-07-08 | 2023-05-09 | 北京航天驭星科技有限公司 | 空间飞行器的跟踪测量方法、装置、电子设备及介质 |
Also Published As
Publication number | Publication date |
---|---|
CN107918139B (zh) | 2021-05-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107918139A (zh) | 一种角速度辅助的Kalman滤波定位方法 | |
US10247576B2 (en) | Method and system for verifying measured data | |
EP2244099B1 (en) | Integrated satellite navigation and dead-reckoning navigation positioning device | |
CN104280746B (zh) | 一种惯性辅助gps的深组合半实物仿真方法 | |
CN105891863B (zh) | 一种基于高度约束的扩展卡尔曼滤波定位方法 | |
CN105606094B (zh) | 一种基于mems/gps组合系统的信息条件匹配滤波估计方法 | |
CN103777218B (zh) | Gnss/ins超紧组合导航系统的性能评估系统及方法 | |
CN107389064A (zh) | 一种基于惯性导航的无人车变道控制方法 | |
CN109471144A (zh) | 基于伪距/伪距率的多传感器紧组合列车组合定位方法 | |
CN105487088B (zh) | 一种卫星导航系统中基于卡尔曼滤波的raim算法 | |
CN108267135A (zh) | 用于轨道自动测量车的精确定位方法及系统 | |
CN104931995A (zh) | 一种基于矢量跟踪的gnss/sins深组合导航方法 | |
WO2007097245A1 (ja) | 測位システム、測位方法及びカーナビゲーションシステム | |
CN101183008A (zh) | 一种用于地面车辆gps导航的惯性补偿方法 | |
CN109059909A (zh) | 基于神经网络辅助的卫星/惯导列车定位方法与系统 | |
CN107436444A (zh) | 一种车载多模式组合导航系统及方法 | |
CN104062672A (zh) | 基于强跟踪自适应Kalman滤波的SINSGPS组合导航方法 | |
CN106501832A (zh) | 一种容错矢量跟踪gnss/sins深组合导航方法 | |
CN101846734A (zh) | 农用机械导航定位方法、系统及农用机械工控机 | |
JPH09230024A (ja) | Gps衛星を利用する測位装置 | |
CN106530789A (zh) | 一种汽车停车点的静态漂移检测方法和系统 | |
CN107110974A (zh) | 导航系统和用于对车辆进行导航的方法 | |
CN104020482B (zh) | 一种高动态卫星导航接收机精确测速方法 | |
Dawson et al. | Radar-based multisensor fusion for uninterrupted reliable positioning in GNSS-denied environments | |
CN103090864A (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 |