从IMU,GPS,和单目视觉里程计(MVO)数据估计姿态GÿdF4y2Ba
该GÿdF4y2BainsfilterErrorStateGÿdF4y2Ba
对象实现传感器IMU,GPS,和单目视觉里程计(MVO)数据的融合来估计NED(或ENU)参考帧的姿势。的过滤器使用一个17元件的状态向量来跟踪方向GÿdF4y2Ba四元GÿdF4y2Ba
,速度,位置,IMU传感器偏差和MVO缩放因子。该GÿdF4y2BainsfilterErrorStateGÿdF4y2Ba
对象使用的误差状态卡尔曼滤波器来估计这些量。GÿdF4y2Ba
创建GÿdF4y2Ba过滤GÿdF4y2Ba
= insfilterErrorStateGÿdF4y2BainsfilterErrorStateGÿdF4y2Ba
默认属性值对象。GÿdF4y2Ba
允许您指定参考帧,GÿdF4y2Ba过滤GÿdF4y2Ba
= insfilterErrorState(GÿdF4y2Ba'参考范围'GÿdF4y2Ba
,GÿdF4y2BaRFGÿdF4y2Ba
)GÿdF4y2BaRFGÿdF4y2Ba
,的GÿdF4y2Ba过滤GÿdF4y2Ba
。指定GÿdF4y2BaRFGÿdF4y2Ba
如GÿdF4y2Ba'NED'GÿdF4y2Ba
(北 - 东 - 下)或GÿdF4y2Ba'ENU'GÿdF4y2Ba
(东 - 北 - 向上)。默认值是GÿdF4y2Ba'NED'GÿdF4y2Ba
。GÿdF4y2Ba
还允许您设置创建的特性GÿdF4y2Ba过滤GÿdF4y2Ba
= insfilterErrorState(GÿdF4y2Ba___GÿdF4y2Ba,GÿdF4y2Ba名称,值GÿdF4y2Ba
)GÿdF4y2Ba过滤GÿdF4y2Ba
使用一个或多个名称值对。单引号括起来每个属性的名称。GÿdF4y2Ba
预测GÿdF4y2Ba |
使用加速度计和陀螺仪的数据更新状态GÿdF4y2Ba |
正确GÿdF4y2Ba |
使用直接测量的状态正确状态GÿdF4y2Ba |
剩余的GÿdF4y2Ba |
从国家直接测量的残余物和剩余协方差GÿdF4y2Ba |
fusegpsGÿdF4y2Ba |
使用GPS数据正确的状态GÿdF4y2Ba |
residualgpsGÿdF4y2Ba |
残差和GPS测量剩余协方差GÿdF4y2Ba |
fusemvoGÿdF4y2Ba |
使用单眼视觉测程正确的状态GÿdF4y2Ba |
residualmvoGÿdF4y2Ba |
残差和从单眼视觉里程计测量残余协方差GÿdF4y2Ba |
姿势GÿdF4y2Ba |
当前的方位和位置估计GÿdF4y2Ba |
重启GÿdF4y2Ba |
复位内部状态GÿdF4y2Ba |
将stateInfoGÿdF4y2Ba |
显示状态矢量信息GÿdF4y2Ba |
注:以下算法只适用于一个NED参照系。GÿdF4y2Ba
insfilterErrorStateGÿdF4y2Ba
使用17轴误差状态卡尔曼滤波器结构来估计NED参考帧的姿势。该状态被定义为:GÿdF4y2Ba
哪里GÿdF4y2Ba
qGÿdF4y2Ba0GÿdF4y2Ba,GÿdF4y2BaqGÿdF4y2Ba1GÿdF4y2Ba,GÿdF4y2BaqGÿdF4y2Ba2GÿdF4y2Ba,GÿdF4y2BaqGÿdF4y2Ba3GÿdF4y2Ba- 定向四元的配件。该定向四元表示从平台的当前方位的框架旋转到当地NED坐标系。GÿdF4y2Ba
位置GÿdF4y2BañGÿdF4y2Ba,GÿdF4y2Ba位置GÿdF4y2BaËGÿdF4y2Ba,GÿdF4y2Ba位置GÿdF4y2BadGÿdF4y2Ba- 在本地NED坐标系统平台的位置。GÿdF4y2Ba
gyrobiasGÿdF4y2BaXGÿdF4y2Ba,GÿdF4y2BagyrobiasGÿdF4y2BaÿGÿdF4y2Ba,GÿdF4y2BagyrobiasGÿdF4y2BažGÿdF4y2Ba- 偏差的陀螺仪读数。GÿdF4y2Ba
accelbiasGÿdF4y2BaXGÿdF4y2Ba,GÿdF4y2BaaccelbiasGÿdF4y2BaÿGÿdF4y2Ba,GÿdF4y2BaaccelbiasGÿdF4y2BažGÿdF4y2Ba- 偏置加速度计读数。GÿdF4y2Ba
比例因子GÿdF4y2Ba- 姿势估计的比例因子。GÿdF4y2Ba
给定的状态转变函数的常规制剂,GÿdF4y2Ba
预测状态估计是:GÿdF4y2Ba
哪里GÿdF4y2Ba
ΔGÿdF4y2BaŤGÿdF4y2Ba- IMU采样时间。GÿdF4y2Ba
GGÿdF4y2BañGÿdF4y2Ba,GÿdF4y2BaGGÿdF4y2BaËGÿdF4y2Ba,GÿdF4y2BaGGÿdF4y2BadGÿdF4y2Ba- 在NED帧常数重力矢量。GÿdF4y2Ba
insfilterAsyncGÿdF4y2Ba
|GÿdF4y2BainsfilterMARGGÿdF4y2Ba
|GÿdF4y2BainsfilterNonholonomicGÿdF4y2Ba