insfilterNonholonomicgydF4y2Ba
估计与非完整约束构成gydF4y2Ba
描述gydF4y2Ba
的gydF4y2BainsfilterNonholonomicgydF4y2Ba
对象实现传感器融合的惯性测量单元(IMU)和GPS数据来估计姿势NED(或ENU表示)参考系。IMU数据来源于陀螺仪和加速度计数据。过滤器使用16-element状态向量跟踪定位四元数、速度,位置,和IMU传感器偏差。的gydF4y2BainsfilterNonholonomicgydF4y2Ba
对象使用一个扩展卡尔曼滤波器来估计这些量。gydF4y2Ba
创建gydF4y2Ba
语法gydF4y2Ba
描述gydF4y2Ba
创建一个gydF4y2Ba过滤器gydF4y2Ba
= insfilterNonholonomicgydF4y2BainsfilterErrorStategydF4y2Ba
对象的默认属性值。gydF4y2Ba
允许您指定的参考框架,gydF4y2Ba过滤器gydF4y2Ba
= insfilterNonholonomic (gydF4y2Ba“ReferenceFrame”gydF4y2Ba
,gydF4y2Ba射频gydF4y2Ba
)gydF4y2Ba射频gydF4y2Ba
的,gydF4y2Ba过滤器gydF4y2Ba
。指定gydF4y2Ba射频gydF4y2Ba
作为gydF4y2BaNED的gydF4y2Ba
(North-East-Down)或gydF4y2Ba“ENU表示”gydF4y2Ba
(East-North-Up)。默认值是gydF4y2BaNED的gydF4y2Ba
。gydF4y2Ba
还允许您创建的设置属性gydF4y2Ba过滤器gydF4y2Ba
= insfilterNonholonomic (gydF4y2Ba___gydF4y2Ba,gydF4y2Ba名称,值gydF4y2Ba
)gydF4y2Ba过滤器gydF4y2Ba
使用一个或多个名称-值对。在单引号附上每个属性的名字。gydF4y2Ba
属性gydF4y2Ba
对象的功能gydF4y2Ba
正确的gydF4y2Ba |
正确的国家使用直接测量状态gydF4y2BainsfilterNonholonomicgydF4y2Ba |
剩余gydF4y2Ba |
残差和残余协方差从直接测量状态gydF4y2BainsfilterNonholonomicgydF4y2Ba |
fusegpsgydF4y2Ba |
正确使用GPS数据gydF4y2BainsfilterNonholonomicgydF4y2Ba |
residualgpsgydF4y2Ba |
从GPS测量残差和残余协方差gydF4y2BainsfilterNonholonomicgydF4y2Ba |
构成gydF4y2Ba |
电流方向和位置估计gydF4y2BainsfilterNonholonomicgydF4y2Ba |
预测gydF4y2Ba |
使用的加速度计和陀螺仪数据更新状态gydF4y2BainsfilterNonholonomicgydF4y2Ba |
重置gydF4y2Ba |
重置的内部状态gydF4y2BainsfilterNonholonomicgydF4y2Ba |
stateinfogydF4y2Ba |
显示状态向量信息gydF4y2BainsfilterNonholonomicgydF4y2Ba |
调优gydF4y2Ba |
调优gydF4y2BainsfilterNonholonomicgydF4y2Ba 参数估计误差减少gydF4y2Ba |
复制gydF4y2Ba |
创建的副本gydF4y2BainsfitlerNonholonomicgydF4y2Ba |
例子gydF4y2Ba
算法gydF4y2Ba
注意:下面的算法只适用于一个NED参考系。gydF4y2Ba
insfilterNonholonomicgydF4y2Ba
使用16-axis错误状态卡尔曼滤波器结构来估计姿势NED参考系。国家的定义是:gydF4y2Ba
在哪里gydF4y2Ba
问gydF4y2Ba0gydF4y2Ba,gydF4y2Ba问gydF4y2Ba1gydF4y2Ba,gydF4y2Ba问gydF4y2Ba2gydF4y2Ba,gydF4y2Ba问gydF4y2Ba3gydF4y2Ba——部分取向四元数。姿态四元数表示一个旋转平台的当前帧定位到本地NED坐标系统。gydF4y2Ba
gyrobiasgydF4y2BaXgydF4y2Ba,gydF4y2BagyrobiasgydF4y2BaYgydF4y2Ba,gydF4y2BagyrobiasgydF4y2BaZgydF4y2Ba在陀螺仪阅读——偏见。gydF4y2Ba
位置gydF4y2BaNgydF4y2Ba,gydF4y2Ba位置gydF4y2BaEgydF4y2Ba,gydF4y2Ba位置gydF4y2BaDgydF4y2Ba——在当地NED平台的位置坐标系统。gydF4y2Ba
νgydF4y2BaNgydF4y2Ba,gydF4y2BaνgydF4y2BaEgydF4y2Ba,gydF4y2BaνgydF4y2BaDgydF4y2Ba——平台的速度在当地NED坐标系统。gydF4y2Ba
accelbiasgydF4y2BaXgydF4y2Ba,gydF4y2BaaccelbiasgydF4y2BaYgydF4y2Ba,gydF4y2BaaccelbiasgydF4y2BaZgydF4y2Ba——在加速度计读数偏差。gydF4y2Ba
考虑到状态转换函数的传统配方,gydF4y2Ba
预测状态估计是:gydF4y2Ba
在哪里gydF4y2Ba
ΔgydF4y2BatgydF4y2Ba——IMU样品时间。gydF4y2Ba
ggydF4y2BaNgydF4y2Ba,gydF4y2BaggydF4y2BaEgydF4y2Ba,gydF4y2BaggydF4y2BaDgydF4y2Ba——不断的重力向量NED框架。gydF4y2Ba
accelgydF4y2BaXgydF4y2Ba,gydF4y2BaaccelgydF4y2BaYgydF4y2Ba,gydF4y2BaaccelgydF4y2BaZgydF4y2Ba——身体的加速度矢量框架。gydF4y2Ba
λgydF4y2BaaccelgydF4y2Ba衰减系数,加速度计的偏见。gydF4y2Ba
λgydF4y2Ba陀螺gydF4y2Ba——陀螺仪偏见衰减系数。gydF4y2Ba
引用gydF4y2Ba
[1]Munguia, R。“一个gps辅助惯性导航系统直接配置。”gydF4y2Ba应用研究和技术杂志》上。gydF4y2Ba第四卷。12日,2014年,页803 - 814。gydF4y2Ba
扩展功能gydF4y2Ba
版本历史gydF4y2Ba
另请参阅gydF4y2Ba
insfilterErrorStategydF4y2Ba
|gydF4y2BainsfilterMARGgydF4y2Ba
|gydF4y2BainsfilterAsyncgydF4y2Ba