[发明专利]一种基于多源信息融合的高精度运动轨迹检测系统

说明书

技术领域

本发明涉及一种运动轨迹检测系统，具体的涉及一种采用惯性传感、机器视觉和电磁定位子系统组成的高精度运动轨迹检测系统，应用领域包括机器人等运动部件的运动轨迹检测。

背景技术

工业机器人和移动机器人等运动部件日益广泛应用导致对其操作性能，尤其是对运动执行器的动态定位精度提出很高的要求。例如工业机器人作为由减速器、伺服电机、增量式编码器和负载反馈单元实现半闭环的运动控制方式，其机械手臂结构高度非线性，高速末端动态变异(偏移、抖动)和高负载变异(末端工具置换)将影响路径定位精度。所以一种高精度的运动轨迹检测系统来实现机器人的实时运动反馈与控制在装配定位、振动分析以及性能指标的测量与评价等应用显得非常的必要。

目前国内外对运动跟踪和定位技术的研究相对集中在射频信号检测定位、惯性传感、磁场定位、视觉定位和声源定位等。基于惯性传感技术的Xsens动作捕捉系统，将加速度计、陀螺仪和磁力计进行信息融合，能获得精度较高的三维姿态信息，因为加速度值二次积分后误差较大，获得的线性位移只能作为参考值。电磁定位系统通过磁传感器阵列对永磁体或者电磁线圈在空间分布的三维磁场强度进行检测，再进行迭代求解得到永磁体或电磁线圈的空间位置和姿态信息，NDI公司的电磁定位系统就采用两个垂直放置的3轴电磁感应线圈实现完整6轴的运动检测，但是电磁定位系统容易受到环境电磁波及铁磁物质的干扰，在工业环境下这种干扰难以避免；基于光学定位技术的VICON动作捕捉系统由红外高速摄像机、一个数据处理器和配套的应用软件构成，红外高速摄像机捕捉被动发光标记点，采用机器视觉原理和激光扫描技术，实现运动位置信息的测量，但光学定位系统只能测量标记点的空间位置信息，且容易受到遮挡以及环境光和背景的影响。

针对光学定位系统容易受遮挡的问题，专利申请号为201410661823.9的中国发明申请，该发明提出一种基于惯性检测的激光跟踪仪靶球定位系统，可实现断光续接功能，便于对难测点或遮档位置的测量，但主要不是提升目标定位跟踪的精度和维度。

因此，在复杂多变的测试环境中，使用单个定位测量系统会存在以下不足：1、测量获得的信息量单一，如光学定位系统只能测量到位置信息，惯性定位系统只能测量到姿态信息；2、受到环境因素的干扰而导致定位精度不高，如电磁定位系统容易受电磁波的干扰，光学定位系统容易受到遮挡以及环境光和背景的影响。

发明内容

为克服单个定位系统存在的问题，本发明的目的在于提供一种基于多源信息融合的运动轨迹检测系统，实现机器人等运动部件的六维位姿的高精度、高稳定和快速运动检测系统。

为解决上述技术问题，本发明采用以下技术方案：

一种基于多源信息融合的高精度运动轨迹检测系统，包括惯性传感定位、电磁定位、机器视觉定位三个模块化的子系统以及数据处理平台，惯性传感定位子系统、电磁定位子系统和机器视觉定位子系统采集的数据均传输到所述数据处理平台，以实现信息融合定位和协作定位；其中：

所述惯性传感定位子系统用于测量运动部件三维姿态角；

所述电磁定位子系统用于测量运动部件三维位置和三维姿态角；

所述机器视觉定位子系统用于测量运动部件三维位置信息；

所述数据处理平台通过将惯性传感定位子系统、电磁定位子系统、机器视觉定位子系统中获取的多源信息进行综合分析和协调处理，基于分布式状态融合结构模型，对数据进行坐标转换和数据校正、数据关联和状态估计融合，综合考虑噪声干扰和环境因素的影响，提升目标动态定位跟踪的精度和维度，增强系统的可靠性和鲁棒性。

优选地，所述的惯性传感定位子系统包括MEMS传感器和第一子处理器，MEMS传感器(包括三轴加速度计、三轴陀螺仪、三轴磁力计)贴附于运动部件来实现实时三维姿态信息的获取，第一子处理器采用卡尔曼滤波或正交余弦矩阵融合算法对MEMS传感器采集的数据进行融合，从而获得运动部件精确的三维姿态角信息。

更优选地，所述的MEMS传感器包括三轴陀螺仪、三轴加速度计、三轴磁力计，所述三轴陀螺仪、三轴加速度计、三轴磁力计采集的数据均传送到第一子处理器，第一子处理器对三者数据进行处理，得到MEMS传感器当前的姿态角，即运动部件的姿态角；其中：

三轴陀螺仪测得角速度、一次积分后得到运动部件偏转的姿态角，但误差会随着时间而累积；

三轴磁力计用于测量地磁强度，进而得到运动部件的航向角；

三轴加速度计测量得到的信号中的三轴重力分量，用于测量运动部件的绝对俯仰角和翻滚角(相对于地球坐标)；