VIO/VINS中关于能观性/可观性的详细讲解
admin
2024-03-23 16:20:50
0次

以前大概写过一下,太烂了。。。也是没什么人写,再详细讲解一下

整体简洁一点尝试主要用文字说明这个比较关键的点,其实整体和多传感器融合也有很大的关联,无论是外感还是内感传感器,无外乎从运动出发或者从观测出发:

这个部分不需要扯到VIO里面非线性优化那块比较复杂的东西,直接列出线性高斯情况下的运动/观测方程:

运动方程:Xk=A(k-1)X(k-1)+Vk+Wk, k=1,....K

观测方程:Yk=CkXk+Nk, k=0,......,K

这2个式子大家应该都很熟悉了,随便敲的格式可能不是很好请忽略,重点是里面那一串矩阵,只列和能观性/可观性相关的核心矩阵:

A: 转移矩阵 C:观测矩阵

输入Vk其实还有个很重要的矩阵B,一般叫控制矩阵,理解为Vk=B*Uk

输入量Vk的噪声协方差矩阵Q,观测变量Yk的一次实现Ymeas协方差矩阵R

能观性/可观性实际上就是判断对应的运动/观测线性方程组是否有唯一解的过程。(VIO里的非线性优化也是一样,最终的方程组,无论是近似目标函数或者近似残差/误差函数,在能观性/可观性判断上是一致的,不要焦虑)。

判断是否有唯一解的标准条件就是:Q>0, R>0, rank(O)=N

首先除了运动和观测的噪声,系统一定还会有未知的偏差,比如视觉里程计的路标观测偏差,以及IMU的随机游走BIAS等,本身这些偏差分量的估计就是状态估计问题的一部分。通常有偏估计我们要加入一个积分器进行处理,在有偏差的运动与观测模型下,能观性矩阵O需进行增广处理,这里面的能观性矩阵O就是一个C,A与B构成的增广矩阵形式。

举2个最直观的二维小车的例子!(来自:“机器人学中的状态估计")

  1. 针对运动方程,如果这个偏差来自于加速度,则系统能观/可观,运动方程有唯一解! 如果偏差同时来自于速度v与加速度a,会使能观性矩阵O出现相同的列,导致O的秩不再等于N,系统不能观/不可观。

  2. 针对观测方程,如果这个系统无偏,则其能观/可观;而当其路标产生偏差时,系统的能观性矩阵O将出现相同的列,导致不能观/不可观。这个非常好理解,即当小车和路标同时移动时,测量不变。

最后是结论:

对于整个机器人状态估计,如VIO,我们最终的目标是求解正定方程:Ax=b,它有3种情况,要么无解,要么唯一解,要么无穷多组解。而在我们的批量BA优化器中,实际是有无穷多组解。

回到VINS系统,4自由度不可观(3平移+yaw),roll和pitch因重力存在而可观。因此我们的初始化才会如此重要,目的就是对状态进行一个初始的估计,确定Pbc,Qbc,GC0,Bias等,而我们在运行过程中的解依赖于我们对初始条件的选取,从另一个角度来说,初始时刻引入的偏置将一直存在于系统中。

相关内容

热门资讯

蜻蜓订购APP贵金属订购非法期...   蜻蜓订购APP以"投资平台"名义对外宣传,主打贵金属期货(订购)交易。该平台一方面强调自身"正规...
悟空订购APP非法期货交易欺骗...   近期,有投资者反映,“悟空订购APP”等平台以白银、贵金属订购为名,宣传所谓“高收益”“低门槛”...
小赢淘金APP期货投资骗局,平...   “小赢淘金”之流,最擅长的就是用“注册送现金”、“充值返券”的糖衣炮弹来引流。别天真地以为那是福...
八方淘金APP非法期货交易欺骗...   警惕!八方生财、每日淘金、小赢淘金、悟空订购、蜻蜓订购、斗金订购等APP均涉嫌非法期货交易!  ...
智易购APP贵金属订购交易骗局...   很多人看到“3元起投”“充值送福利”“操作简单”“随时提现”这类宣传,很容易把智易购APP当成普...
喜玛银庄APP商品订购投资骗局...   喜玛银庄APP白银、铂金“现货订购”骗局警示:无资质平台涉嫌非法期货交易,投资者爆仓后如何维权?...
吉鑫乐享APP炒贵金属订购交易...   近期,多名投资者反映在“吉鑫乐享APP”进行贵金属投资时遭遇严重亏损,甚至血本无归。看似正规的“...
易掘金APP虚假期货投资骗局,...   “易掘金”的APP它打着“高收益、灵活投资”的旗号,宣称通过“商品订购”就能轻松赚钱,吸引了不少...
在大吉订购APP订购交易亏损被...   近期,不少投资者反映在“大吉订购App”上投资白银、铂金等商品遭遇严重亏损。该平台宣称提供现货订...
铂银壹号APP商品订购交易亏损...   许多中小投资者误以为网上的“商品现货订购”是合规合法的理财渠道,殊不知这背后隐藏着巨大的合规风险...
兴鑫淘金APP贵金属订购交易亏...   白银、贵金属或其他商品类投资,除国家批准的正规期货交易场所及持牌期货公司外,市面上大量第三方交易...
铂银掘金APP无资质的违规平台...   铂银掘金等平台的投资者,往往是被“注册送现金”“充值返现券”“首单免亏”等广告话术吸引,进而下载...
八方淘金APP订购交易不合规,...   “八方淘金APP”“铂银掘金APP”“铂银壹号APP”等软件被指以“现货订购”为名,实际采用高杠...
在指尖订购APP订购商品亏损被...   指尖订购APP这类平台,表面是“订购交易”,实则是披着电商外衣的非法期货陷阱。绝大多数投资者被蒙...
在犀贝易购APP做商品订购交易...   市面上打着“现货投资”“贵金属交易”旗号的APP并不少,但真正合规、受监管的平台并不多。犀贝易购...
易达淘金APP虚假商品订购交易...   易达淘金APP存在严重的虚假宣传与违规交易行为。该平台打着“商品订购”的旗号,实则通过不合规的交...
大浪淘金APP白银订购亏损被骗...   大浪淘金APP最隐蔽的套路,在于其完全封闭的内盘交易系统。表面上,它宣称与国际贵金属市场接轨;实...
一品好购APP上订购白银出现亏...   一品好购APP原名“一品订购”,运营方为上海宝智未来信息技术有限公司。近期不少投资者反映在该平台...
九州订购APP贵金属订购投资骗...   九州订购APP正通过抖.音、快手、今日头条等平台大量投放投资广告,用“5元起投”“充值返现”“0...
坚锅淘金APP交易软件并不正规...   当前,市面上大量所谓的“现货商城订购”交易软件,早已偏离了正常的实物商品买卖,演变为高杠杆、高手...