多体机械系统的动态定位方法

摘要

本发明公开了一种多体机械系统的动态定位方法，所述方法假定多体机械系统兴趣点在X轴、Y轴和Z轴三个方向上是相互独立的，构建每个方向上解耦独立运行的卡尔曼滤波器，利用图像传感器和惯性导航传感器的融合实现多体机械系统兴趣点的位置估计。本发明实现了多体机械系统点的连续三维定位，且定位精度不受短时间遮挡的影响，这为刚体的质心位置测量和姿态角测量以及模型验证提供了基础。