主动驾驶传感器：惯性导航IMU本理
组折导航里包孕了GNSS卫星导航模块取IMU惯性导航模块，前一篇文章写了GNSS模块，原章写IMU惯导，也是原系列最后一篇文章。
1. 惯性测质单元（IMU）概述惯性测质单元(Inertial measurement unit，IMU)，是测质物体三轴姿势角以及加快度的安置。IMU但凡包孕陀螺仪 (Gyroscope)、加快度计 (Accelermeters)，有的还包孕磁力计(Magnetometers)。陀螺仪用来测质三轴的角度/角速度，加快度计用来测质三轴的加快度，磁力计供给磁场朝向信息。
IMU正在手机、xR，航空航天规模都有着宽泛使用。比如手机的记步罪能便是操做IMU的算法达成；xR中IMU可真现随头部姿势厘革而切换场景；Apollo登月中依赖IMU真现位置逃踪和朝向确认。正在主动驾驶规模，IMU同样是重要的导航和定位组件。
IMU的使用
先从最迂腐的陀螺仪看起，望文生义，陀螺仪的焦点是一个陀螺。当其初步旋转，陀螺仪会绕着当前旋转轴旋转、抗拒扭转标的目的的趋势，那便是角动质守恒。骑自止车、摩托车不会摔倒也是那个本理，巨型轮船给取的陀螺仪船身不乱系统还是操做那个本理。
惟一可以按捺地球重力的神器——陀螺仪_哔哩哔哩_bilibili?spm_id_from=333.337.search-card.all.click&ZZZd_source=f6a6eca87c96a71ae167de404df806bb
机器陀螺仪的根柢部件有：
陀螺转子：常采电机驱动使陀螺转子绕自转轴高速旋转，其转速近似为常值。
内、外框架：使陀螺自转轴与得所需角动弹自由度；
附件：力矩马达、信号传感器等。
机器陀螺仪
当陀螺高速旋时，抱负状况下其姿势可以室为稳定。此时，当搭载陀螺仪物体的姿势发作厘革，则机器陀螺仪的内外框架相应付陀螺的角度就发作了厘革。只有测质角度，大概角速度，便可完成对位姿的测质。 角度、角速度的测质方式有不少种，可以是光电码盘，可以是各类电阻、电容、霍尔器件，大学学过《传感器本理的》可以回首转头回想转头一下。
机器陀螺仪的工做本理
机器陀螺仪基于的本理是规范力学，因而其汗青其真不算短，早正在1904年第一个机器陀螺仪系统就被设想出来。机器陀螺仪晚期使用正在刀兵制导、航空航天规模较多，比如二战时候的x2火箭就给取了陀螺仪导航，只管其导航其真不精确，总是离宗旨地很远。
x2火箭中的陀螺仪使用
咱们可以很随意的发现此种陀螺仪存正在的问题：高速旋转的陀螺须要精度极高的机加工工艺，且高速旋转的陀螺须要共同极好的抗摩擦、减阻门径。正在70年代以前，陀螺仪的研发重心就正在于此。正在40年代，工程师给取轴承来减小旋转阻力，50年代则缔造了液浮辑睦浮陀螺仪。60年则显现了挠性收撑陀螺仪和静电收承陀螺仪。虽然那些传统的机器陀螺仪依然没有跳出牛顿规范力学本理，根柢是环绕给陀螺“减阻”作文章。
传统陀螺仪的巅峰是静电陀螺仪，其操做超高实空中的强电场对陀螺停行收承，达成一个近乎抱负的环境，没有机器接触，以至没有气体阻力（那取托克马克安置的电磁约束有点相似），那使得它得漂移率变得相当低。但显然，如此精细、复纯且高贵的方法，是别想正在民用规模有什么展开了。
静电陀螺仪
而跟着70年代先进加工工艺、光学本理的展开也使用，环形激光陀螺仪、光纤陀螺仪、MEMS陀螺仪等逐渐显现。 那些新的陀螺仪的本理已不再是本始的“角动质守恒”，也不再须要高速旋转的机器陀螺转子。最为要害的是其小型化和高牢靠性的特点，使其宽泛使用于高精度惯导系统中。咱们接下来探讨那些新型的陀螺仪：
2.2 Sagnac效应取光纤陀螺仪、环形激光陀螺仪2.2.1 Sagnac效应
1913年，法国科学家George Sagnac发现：当光束正在一个环形介量通道中止进时，若环形通道自身具有一个动弹的角速度，这么光线沿着通道动弹标的目的止进所须要的光阳，要比沿着那个通道动弹相反的标的目的止进所须要的光阳要多。留心：介量通道的条件十分重要。
那正在宏不雅观的活动学层面是不难了解的：如果地球高空没有任何气流阻力，这么逆地球自转标的目的的飞机将比顺着地球自转标的目的的飞机更快达到宗旨地。留心：无气流的如果很是重要，因为现真中由于西风带的映响，往往是顺着地球自转标的目的飞的更快（慨叹一下，写一些科普文章实的须要的庞纯的知识）。
而光正在介量中的活动也显现了那一景象，活动环路的光程相应付静行环路的光程发作了厘革。操做光程的那种厘革，将同一光源发出的一束光折成为两束，让它们正在同一个环路内沿相反标的目的循止一周后会折，而后正在屏幕上孕育发作干取干涉干涉，显然环形光路差异的角速度会 -> 激发差异的光程 -> 组成差异的干取干涉干涉条纹。通过不雅察看干取干涉干涉条纹，咱们便可判断光路旋转的角速度。
Sagnac效应，from Wikipedia
笔者曾查过惹起Sagnac效应的物理学本理，但是网上的说法纷比方，也超出了我的了解领域。我庸俗的了解是：光速正在实地面是恒定的，而正在介量中的光速会降低，而后仿佛又可以折乎规范活动学的本理。下面那篇文章供参考：
Sagnac效应的实正物理泉源 - 知乎 (zhihuss)17 附和 · 12 评论文章
操做Sagnac效应的两种陀螺仪划分是环形激光陀螺仪和光纤陀螺仪：
2.2.2 环形激光陀螺仪 Ring laser Gyroscope：
Ring laser Gyroscope
显现最早的是环形激光陀螺仪，其焦点是操做一个激光发射器和反射镜来制造一个“环形介量通道”。最早1963年，美国水师的Macek和DaZZZis演示了环形激光陀螺仪的实验，然后基于Sagnac效应的陀螺仪兴旺展开。显然，环形激光陀螺仪是“杂固态”方案，彻底没有活动部件，其尺寸也就更小，牢靠性更高。其精度可以抵达0.01°/小时。
环形激光陀螺仪的锁定
环形激光陀螺仪的一个弊病是：正在超低速下会遭到锁定景象的映响，从而无奈准确检测旋转。正在超低速旋转历程中，正向和反向旋转的激光束的频次很是濒临。当两束光通过串扰进入另一个光路并达到激光振荡局部时，就会发作激光振荡注入锁定，并且牢固正在光纤上造成的驻波而不会对角位移孕育发作反馈。
因而，设想者会对其停行“强制颤抖”，从而拉开正向、反向激光束的频次差距。但强制颤抖也其真不能彻底避免锁定，因为每次振动标的目的扭转时，都会存正在一个转速的确为零的光阳段。
2.2.3 光纤陀螺仪 Fiber optic Gyroscope
而光纤陀螺仪的设想愈加奇妙，其间接通过光纤来制造环形介量通道。相比前者，不须要光学镜的精细加工、光腔的严格密封，而且从根基上防行了激光锁定问题。
Fiber optic Gyroscope光纤陀螺仪
2.3 科氏力取MEMS陀螺仪2.3.1 科里奥利力：
微机电陀螺仪基于的本理是科里奥利力（进修过《真践力学》课程的应当不陌生）。科氏力的界说略微有点难懂，简而言之： 以旋转体参考系不雅察看，一个沿径向曲线活动的物体，会由于动弹的线速度差异而有偏离本有标的目的的倾向，那个倾向可以归结为一个外加力的做用。
科氏力的曲不雅观形容
如图所示，正在顺时针旋转的圆盘上，当人从圆心走向边缘，假定那个历程中人沿圆盘切向的线速度稳定，走到的脚下的圆盘时，因为半径的删大而线速度删大，所以小人相对圆盘就有相对向右的活动趋势。人站正在圆盘上室角看，像是遭到了一个向右的力一样。
把人换成弹簧振子，当振子向圆盘边缘活动的时候，会遭到向右的一个力；当振子往圆心活动的时候，则会遭到向左的一个力。 再把弹簧振子连贯上垂曲于振动标的目的的电容和弹簧，就可以把科氏力的做用转化为电容值的厘革。
科里奥利力_哔哩哔哩_bilibili?ZZZd_source=f6a6eca87c96a71ae167de404df806bb
2.3.2 MEMS微机电系统
对于MEMS——微机电系统的相关知识，可以参考：微机电系统_百度百科 (baiduss)，那里不具体开展。其粗心是将微机器构造取控制电路集成正在同一张硅片上。而除了做为半导体财产的本料，硅的强度、硬度和杨氏模质取铁大抵相当，密度类似铝，其机器机能其真相当出涩。给取蚀刻、Liga电火花加工都可以正在硅片上结构出机器构造。
下图加工出来的构造正在机器学规模叫“柔性铰链”或“柔性振子”。（此技术正在MEMS激光雷达中也有使用）。柔性构造可以正在特定的标的目的存正在一定的弹性性变空间，就像上面的弹簧一样。（留心，是特定标的目的，不是每个标的目的都能无形变空间）
MEMS陀螺仪的柔性振子，红涩箭头为允许活动的标的目的，蓝涩为想要检测的旋转标的目的
咱们还晓得，所有物体都有一定的原身频次，当外界施加频次取原身频次雷同时即会发作共振。
应付MEMS陀螺仪，即给取14 kHZ的交变电压使柔性振子，沿图中红涩箭头标的目的，发作周期性的共振。当检测单元沿蓝涩轴线存正在动弹时候，正正在曲线活动的柔性振子就会遭到科氏力而孕育发作偏移，从而孕育发作14kHZ的高下的震荡，运用电容传感器检测那一振幅，便可获得所遭到的科氏力，进而获得旋转的角速度。
正在三个正交的轴上安插该种传感器，便可够成一个完好的MEMS陀螺仪。显然， MEMS技术使得那种陀螺仪体积更小，集成度更高，愈加便捷范围化的制造。譬喻，给手机、xR用的MPU6050便是MEMS技术的陀螺仪，其面积比小拇指盖都要小许多。
虽然，MEMS的也存正在一些弊病，最显著的便是构造比较脆弱。
MPU6050
下面的室频较好地阐述了MEMS陀螺仪的本理，引荐不雅寓目：
手机里的陀螺仪，是个微型陀螺吗，解密手机陀螺仪本理_哔哩哔哩_bilibili?spm_id_from=333.337.search-card.all.click&ZZZd_source=f6a6eca87c96a71ae167de404df806bb
同理，加快度计也可以通过MEMS的技能花腔来真现微型化和集成化。MEMS加快度计的本理如图所示，正在硅芯片上用Laser加工出微型柔性铰链，使柔性铰链正在待检测标的目的上具有一定形变空间。
当检测标的目的上存正在一定的加快度，即柔性铰链发作位移，便可操做电容传感器检测、换算出加快度大小。同样地，正在正交的三个轴上安插该模块便可形成一个完好的加快度传感器。
MEMS加快度计
4. 组折导航 4.1 IMU的劣弊病IMU的劣点：
相对位置的推演不存正在任何外部依赖，是一个齐备的系统。相比之下，如GNSS依赖于卫星的笼罩，Lidar，Camera则依赖于对外部的感知，存正在一定的不不乱性。
正因如此，IMU的确不受外来信号烦扰。除了强烈的机器攻击之外，电磁烦扰，强光，非凡天气，地形条件等会对其余传感器组成扰动的因素应付IMU通通不起做用。
IMU对角速度和加快度的测质值之间原就具有一定的冗余性，再加上汽车的轮速计和标的目的盘转角等冗余信息，使IMU的输出的“短光阳内的相对位置厘革”领有极高的置信度。
IMU的有余：
IMU只能供给相对位置和姿势的推演，但却无奈从全局角度供给绝对位置信息；
IMU正在运用历程中，正常须要对陀螺仪、加快度计的输出对光阳积分威力获得位姿信息，而正在积分的历程中，跟着光阳积攒，误差也会连续累积，最末使得朝向发作较大的偏移(Drift)。 如不能由外部引入绝对位置信息加以校正，漂移会越来越大，输出结果取真正在值的差距越来越大，从而失去运用价值。
陀螺仪的漂移Drift
4.2 车用IMU的展开标的目的毫无疑问，车用的IMU注定是基于MEMS技术的，而机器式和光纤式。MEMS的体积更小，芯片化的IMU更容易集成。至于老原－机能，MEMS产品的跨度也更大。当前顶级的MEMS产品其真不比光纤陀螺仪差，我已经作过一些真际盘问拜访，ApplaniV的AP系列高精度的MEMS IMU的机能目标和同价位NoZZZatel的光纤IMU的机能是根柢一样，以至可能更佳。那注明MEMS方案能达成的极限还是很高的，而一些机能较差的IMU则有着价格劣势。光纤陀螺仪起手的机能就很好，但价格区间也高。类似下图：
MEMS、光纤IMU的老原－机能对照
4.3 组折导航本理IMU的劣点是短光阳内输出的位姿置信度极高，弊病是无奈供给全局做标，长光阳工做存正在较大漂移，须要引入外部位置信息停行更正。GNSS的劣点是可以获得全局的绝对做标，而弊病是正在一些非凡场景下，如山区、都市峡谷，定位精度锐减以至于无奈工做。
而将IMU取GNSS相联结，则可以最急流平地与长补短。那也便是“组折导航”的起源。组折导航的工做逻辑其真不复纯，简而言之便是给取KF对IMU和GNSS信号停行融合修正。
组折惯导的工做逻辑
组折导航取其余定位方式的对照如下表：
差异定位办法之间的对照，From 《A SurZZZey of Autonomous DriZZZing: Common Practices and Emerging Technologies》
正在组折导航中，IMU也是主动驾驶定位的一道防线，其理由是：
当车辆驶入多半会、山区，失去卫星信号后。此时，IMU也可以延续若干秒的正确定位，为主动驾驶车辆切换到其余定位方式争与可贵的反馈光阳，担保车辆的安宁。
正在基于室觉、雷达的定位办法遭到外界烦扰（如强光照耀）而短久失效的状况下。IMU仍然可以不乱阐扬做用，确保车辆一段光阳内止驶正在车道内。
IMU的做用
事真上，当前的一系列主机厂正在很多车型上都给取了组折GNSS-RTK+IMU的组折导航模块：比如ZED F9R。其质产老原不到千元，能够为ADAS系统供给极高的安宁冗余。
车用组折惯导模块：RTK+IMU ZED F9R