捷联惯导系统学习2.5(等效旋转矢量微分方程的泰勒级数解)
在高精度的捷联惯导系统中,陀螺仪姿态的解算往往是通过采集一定时间内的角增量信息,
计算角增量信息计算出等效旋转矢量,在通过等效旋转矢量递推余弦阵或者四元数,完成姿态更新。
等效旋转矢量微分方程的泰勒级数解
利用泰勒级,计算出数角增量的等效旋转矢量。
二字样法:
假设:0-T时间(4元数更新时间段)内陀螺仪为线性输出即:
w(t)=a+2bt(t∈[0,T])w(t)=a+2bt( t\in[0,T])w(t)=a+2bt(t∈[0,T])
Δθ(t)=∫0tw(t′)dt′=at+bt2\Delta \theta(t)=\int_0^tw(t')dt'=at+bt^2Δθ(t)=∫0tw(t′)dt′=at+bt2
σ(t)=Δθ(t)×w(t)\sigma(t)=\Delta\theta(t)\times w(t)σ(t)=Δθ(t)×w(t)
Δθ(t)\Delta \theta(t)Δθ(t)(角输出增量,2阶导以上全部为零(证略));
σ(t)\sigma(t)σ(t)(不可交换误差修正量,4阶导以上全部为零(证略))
ϕ(t)=Δθ(t)+σ(t)\phi(t)=\Delta \theta(t)+\sigma(t)ϕ(t)=Δθ(t)+σ(t)
将ϕ(t)\phi(t)ϕ(t)在t=0初用泰勒级数展开
ϕ(t)=ϕ(0)+Tϕ˙(0)+T22!ϕ(0)′′+....=0+Ta+T2b+T36a×b\phi(t)=\phi(0)+T\dot\phi(0)+\frac{T^2}{2!}\phi(0)^{''}+....=0+Ta+T^2b+\frac{T^3}{6}a\times bϕ(t)=ϕ(0)+Tϕ˙(0)+2!T2ϕ(0)′′+....=0+Ta+T2b+6T3a×b
=Ta+T2b+T36a×b=Ta+T^2b+\frac{T^3}{6}a\times b=Ta+T2b+6T3a×b
为了求解a,b需要在一个四元数更新周期内进行两次采样:
Δθ1=∫0T/2w(t)dt=T2a+T24b\Delta\theta_1=\int_0^{T/2}w(t)dt=\frac{T}{2}a+\frac{T^2}{4}bΔθ1=∫0T/2w(t)dt=2Ta+4T2b
Δθ2=∫T/2Tw(t)dt=T2a+3T24b\Delta\theta_2=\int_{T/2}^{T}w(t)dt=\frac{T}{2}a+\frac{3T^2}{4}bΔθ2=∫T/2Tw(t)dt=2Ta+43T2b
ϕ(T)=Δθ1+Δθ2+23Δθ1×Δθ2\phi (T)=\Delta\theta_1+\Delta\theta_2+\frac{2}{3}\Delta\theta_1\times\Delta\theta_2ϕ(T)=Δθ1+Δθ2+32Δθ1×Δθ2
三字样法:
假设:0-T时间(4元数更新时间段)内陀螺仪为线性输出即:
w(t)=a+2bt+3ct2(t∈[0,T])w(t)=a+2bt+3ct^2( t\in[0,T])w(t)=a+2bt+3ct2(t∈[0,T])
需要在[0,T]内进行3次采样:
Δθ1=∫0T/3w(t)dt\Delta\theta_1=\int_0^{T/3}w(t)dtΔθ1=∫0T/3w(t)dt
Δθ2=∫T/323Tw(t)dt\Delta\theta_2=\int_{T/3}^{\frac{2}{3}T}w(t)dtΔθ2=∫T/332Tw(t)dt
Δθ3=∫23TTw(t)dt\Delta\theta_3=\int_{\frac{2}{3}T}^{T}w(t)dtΔθ3=∫32TTw(t)dt
ϕ(T)=Δθ1+Δθ2+Δθ3+3380Δθ1×Δθ3+5780Δθ1×Δθ2+5780Δθ2×Δθ3\phi (T)=\Delta\theta_1+\Delta\theta_2+\Delta\theta_3+\frac{33}{80}\Delta\theta_1\times\Delta\theta_3+\frac{57}{80}\Delta\theta_1\times\Delta\theta_2+\frac{57}{80}\Delta\theta_2\times\Delta\theta_3ϕ(T)=Δθ1+Δθ2+Δθ3+8033Δθ1×Δθ3+8057Δθ1×Δθ2+8057Δθ2×Δθ3
单字样法:(频率相同时精度与二子样法相同,频率更高)
需要知道前一周期角增量Δθ0\Delta\theta_0Δθ0
角速度输出为:
w(t)=a+2bt(t∈[−T,T])w(t)=a+2bt( t\in[-T,T])w(t)=a+2bt(t∈[−T,T])
ϕ(T)=Δθ1+112Δθ0×Δθ1\phi (T)=\Delta\theta_1+\frac{1}{12}\Delta\theta_0\times \Delta\theta_1ϕ(T)=Δθ1+121Δθ0×Δθ1
捷联惯导系统学习2.5(等效旋转矢量微分方程的泰勒级数解)相关推荐
- 捷联惯导系统学习4.1(惯导数值更新算法)
1 常用坐标系的定义 (1)地心惯性坐标系(i 系,inertial frame) 用oixiyizio_ix_iy_iz_ioixiyizi表示,原点以地球为中心, 原点oio_ioi在地 ...
- 捷联惯导系统学习7.5(低成本组合导航系统模型)
低成本组合导航系统模型 低精度MEMS惯性/卫星/地磁组合导航系统中,选择惯导系统的姿态失准角ϕ\phiϕ.速度误差δvn\delta v^nδvn.定位误差δpn\delta p^nδpn.陀螺仪相 ...
- 捷联惯导系统学习3.2(地球的正常重力场)
圆球模型下的地球重力 如图,重力为引力与离心力作用的共同结果,其中 引力:F=GMr2=ur2(G引力常数,M为地球质量,r为质点到地心距离)F=\frac{GM}{r^2}=\frac{u}{r^2 ...
- 捷联惯导系统学习6.1(一些卡尔曼滤波处理技术 )
噪声相关条件下的Kalman滤波 理想状态下的kalman需要系统噪声与测量噪声之间部不相关,如果测量噪声与系统噪声相关需要进行处理 噪声相关条件下的系统状态方程 Xk:n维状态向量X_k:n维状态向 ...
- 捷联惯导系统学习6.6(Sage-Husa自适应滤波 )
原理作用 只有准确的获得系统的结构参数和噪声统计特性参数,才能获得最优值的状态估计,实际中往往是不够准确的 可以使用量测输出(输出隐含了系统模型的某些信息)对系统系统模型进行重新估计. 量测噪声方差阵 ...
- 捷联惯导系统学习2.6(圆锥误差补偿多子样算法)
若圆锥运动的四元数更新方程为: Q(tm)=Q(Tm−1).Q(T)Q(t_m)=Q(T_{m-1}).Q(T)Q(tm)=Q(Tm−1).Q(T) ( ...四元数乘法) ( Q(T)Q(T)Q ...
- 捷联惯导系统学习2.2(等效旋转矢量)
二 等效旋转矢量: 1 一些重要的三维矢量运算关系(证明请自己找) $ u为单位矢量 ;u'是u的一阶导数$ (1):V1×(V2×V3)=(V1∗V3)V2−(V1∗V2)V3(1):V_1\tim ...
- 捷联惯导系统学习2.5(等效旋转矢量微分方程)
已知三维旋转矢量关系如下:(证明略) 参数说明: ViV_iVi表示三维空间矢量 v=∣V∣=VVTv=|V|=\sqrt{VV^T}v=∣V∣=VVT表示矢量模值 uuu为与V同方向的单位矢量即 ...
- 捷联惯导系统学习6.2(序贯滤波 )
序贯滤波(sequential Kalman filtering) 一种将高维数据量测更新降低为多个低维数量测更新的方法,有效降低矩阵的求逆计算量(通过把矩阵对角化,将对角拆开分开计算) 特别的对于如 ...
最新文章
- 进程间通信(三)—信号量
- 高质量程序设计指南c++/c语言(33)--函数指针
- JAVA开发者的Golang快速指南
- java实现扫地agent_如何实现java agent?分享java agent的使用案例
- 安装tensorflow_gpu,无法定位程序输入点
- SAP HANA里执行SQL语句的两种方式
- 转-HTC 手机生产日期,产地查询 以及 SN码 IMEI码 查询等问题汇总
- 深入浅出 RPC - 浅出篇+深入篇
- SQL SERVER中的纵横查询
- ajax struts 返回html,Struts2+ajax 异步请求,向前段返回字符串
- app抢购脚本如何编写_如何用1个记事本文件征服全世界?——cmd批处理脚本编写...
- 不好,两群AI打起来了!“幕后主使”是上海交大~
- [转]20个优秀网站助你征服CSS
- mysql 写入性能_MySQL存储写入性能严重抖动分析
- QD75D416轴PLC控制伺服电机16轴完整案例
- 微信网页开发调试的一些方法
- 发音问题纠正:边音l和鼻音n,前鼻音与后鼻音的区别与发音
- 台式计算机光标时不时跳动,苹果电脑打字乱跳光标怎么办?MacBook打字时光标乱跳的解决办法...
- 实用电脑软件安利,朋友们快来挖宝
- hc sr501 c语言程序,HC-SR501人体红外感应模块资料汇总(原理图、常见问题、程序等)...