惯性导航算法(一)

惯导机械编排算法

预备知识

image-20221102204801385 image-20221102204928595 image-20221102205644140 image-20221102212123016

欧拉角法

image-20221102212739448 image-20221102212955069 image-20221102220857730

这里务必注意:欧拉角正方向定义是从R系->b系 ,即从参考系->当前的载体系

image-20221102220835356

欧拉角微分方程

建立 陀螺输出的w与欧拉角微分的关系 (后续因欧拉角限制不会使用)

image-20221104191104431

方向余弦矩阵

image-20221104204609060 image-20221104211322950

方向余弦阵性质

image-20221104211425823 image-20221104222130231

理解:

DCM小角度时,

image-20221105104155205

C b R = I + ( α R b × ) C_b^R = I + (\alpha_{Rb} \times) CbR=I+(αRb×)

C b ( t k ) t ( k − 1 ) = I + Δ θ b t ( k − 1 ) b t k × C_{b(tk)}^{t(k-1)} = I + \Delta \theta_{b_{t(k-1)}b_{t_{k}}}\times Cb(tk)t(k1)=I+Δθbt(k1)btk×

方向余弦矩阵的微分方程

image-20221105110828531

但实际完成姿态更新时,由于陀螺输出的角速度是 ω i b b \omega_{ib}^{b} ωibb ω R b b \omega_{Rb}^{b} ωRbb,需要补偿掉i系与n系之间的地球自转和牵连角速度

微分方程的求解

image-20221105210014487 image-20221105214159395

以上计算前提是假设b系相对于R系角速度方向保持不变

四元数

image-20221105221455105 image-20221105221942499 image-20221105222043072 image-20221105222130362 image-20221105222257288

注意:

纯虚四元数乘法,分块矩阵方法:(实部 + 虚部)

image-20221106093006903 image-20221106093448197 image-20221106093632379 image-20221106093815450

四元数共轭 <==> 矩阵转置

四元数逆 <==> 矩阵的逆

四元数的三角函数表示

image-20221106100632895 image-20221106100808025

模长为1的四元数 可以表示 三维空间的姿态旋转

可以等价理解为 模长为1的复数可以 表示二维空间的旋转

p = ∣ ∣ l e n g t h ∣ ∣ e i θ , w h e n l e n g t h = 1 , p c o u l d o n l y d e s c r i b e p o s e i n 2 − d i m e n s i o n s p a c e p = ||length||e^{i\theta}, when length = 1, p could only describe pose in 2-dimension space p=lengtheiθ,whenlength=1,pcouldonlydescribeposein2dimensionspace

四元数算子证明*

image-20221106100955602
  • 欧拉旋转定理
image-20221106101121401

姿态四元数

image-20221106103122759

一般做姿态投影都转化为 方向余弦阵,考虑到向量旋转投影变换四元数乘法需要做两次

四元数的微分方程

image-20221106194405232 image-20221106194611882 image-20221106194934204

四元数和DCM更新时的 不可交换误差 问题

image-20221106195246560 image-20221106195707702

等效旋转矢量

image-20221108223624637

image-20221108223739153

image-20221108224140066

image-20221108224714999

image-20221108225538847

image-20221108230621257

image-20221108232036193

image-20221108232536856

圆锥误差补偿:载体在做圆锥运动时,不可交换误差补偿项较大

姿态更新算法小结

image-20221113085240825

更正: 蓝色字体第二点 增量应为w_in^{n},因为是n系的更新。

image-20221113090050457
  1. 这里边用到了w_ie^{n},需要载体速度V_E,V_N
  2. 初始姿态由初始对准算法给定
image-20221113091619547

姿态表达根本上是为了向量投影,实际常用方向余弦矩阵和四元数

RV仅用在多子样算法补偿不可交换误差的情况

  • 7
    点赞
  • 78
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
自动驾驶是通过深度融合人工智能、物联网、云计算等新一代信息技术而产生的一种技术。而惯性导航算法是在自动驾驶中的一个重要模块,它用于确定车辆的速度、加速度、航向和姿态等信息,并将这些信息与其他传感器信息和车身信息进行融合,以实现车辆的稳定导航。 惯性导航系统的基本工作原理是通过测量载体在惯性参考系的加速度,将其对时间进行积分并转换到导航坐标系中,从而得到车辆在导航坐标系中的速度、偏航角和位置等信息。该系统不依赖外部参考坐标系,可以实现自主导航。惯性导航系统主要包括陀螺仪和加速度计两个传感器,通过测量物体的角速度和加速度来计算速度和位移。 在自动驾驶中,惯性导航系统的应用目前还处于起步阶段,其竞争力主要体现在算法上。算法包括了惯性传感器的标定以及速度、加速度、航向和姿态的确定,还涉及与其他传感器信息和车身信息的融合。算法的优劣决定了传感器能否发挥最佳性能,同时也影响着惯性导航系统的稳定性和可靠性。 随着自动驾驶技术的不断提升,对惯性传感器芯片的性能要求也会持续提高。惯性传感器芯片的设计、制造、封测和标定将成为惯性导航系统中关键的环节。目前来看,惯性导航系统的竞争力主要体现在算法的优化和惯性传感器芯片的性能提升上。 综上所述,惯性导航算法是自动驾驶中的一个重要模块,它用于确定车辆的速度、加速度、航向和姿态等信息,并与其他传感器信息和车身信息进行融合,以实现稳定的导航。惯性导航系统的竞争力主要取决于算法的优化和惯性传感器芯片的性能提升。<span class="em">1</span><span class="em">2</span><span class="em">3</span> #### 引用[.reference_title] - *1* *3* [惯性导航算法_自动驾驶关键技术报告:惯性导航和背后的芯片大战](https://blog.csdn.net/weixin_39782752/article/details/111341064)[target="_blank" data-report-click={"spm":"1018.2226.3001.9630","extra":{"utm_source":"vip_chatgpt_common_search_pc_result","utm_medium":"distribute.pc_search_result.none-task-cask-2~all~insert_cask~default-1-null.142^v93^chatsearchT3_1"}}] [.reference_item style="max-width: 50%"] - *2* [自动驾驶专题介绍 ———— 惯性导航](https://blog.csdn.net/qq_42957717/article/details/126322333)[target="_blank" data-report-click={"spm":"1018.2226.3001.9630","extra":{"utm_source":"vip_chatgpt_common_search_pc_result","utm_medium":"distribute.pc_search_result.none-task-cask-2~all~insert_cask~default-1-null.142^v93^chatsearchT3_1"}}] [.reference_item style="max-width: 50%"] [ .reference_list ]

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值