一种基于机器视觉的圆锥运动测量方法

1.本发明属于运动测量领域，更为具体地讲，尤其涉及一种圆锥运动测量方法。


背景技术：

2.mems惯性传感器具有小体积、高集成、高精度、低成本等优点，被广泛应用于结构健康监测、自动驾驶、智能穿戴、导航等不同领域。这些领域通常需要mems惯性传感器具有高精度轨迹跟踪性能，为此需对mems惯性传感器进行动态性能测试，实现对该性能的评估。
3.stewart平台可实现空间复杂运动轨迹，由stewart平台产生绕z轴的圆锥运动可测试mems惯性传感器的跟踪性能。但由于stewart平台的伺服电机存在相位滞后和幅值衰减，导致stewart平台的实际终端位姿与理论位姿存在偏差。为了保证mems惯性传感器测试结果的可靠性，需要实现stewart平台运动轨迹的高精度测量。
4.目前，常用的stewart平台运动轨迹测量方法有传感器测量法、激光跟踪仪测量法以及机器视觉测量法。其中，传感器测量法常用拉线编码器或编码器通过测量变化长度，利用矢量闭环法来实现测量；激光跟踪仪测量法和机器视觉测量法通过测量放置于动平台上的靶标的实时空间坐标来实现stewart平台的运动轨迹获取。上述几种方法均默认动平台坐标系原点位于动平台圆心处。但由于加工误差以及控制误差，动平台坐标系原点(即圆锥运动的实际锥点)通常与动平台圆心存在一个微小误差。为了提高运动轨迹测量精度，需要研究一种新的测量方法能测出动平台坐标系的实际原点位置。
5.因此，本文提出一种基于物理解耦的圆锥运动机器视觉测量方法。该方法通过增加投点器坐标系和背投幕坐标系，将stewart平台的空间运动转化为三个激光点的平面运动，增加了运动信息以实现真实锥点空间位置信息测量以及圆锥运动信息的测量。该方法有利于实现高精度的圆锥运动实时测量。


技术实现要素：

6.针对目前圆锥运动测量方法存在测量系统成本高、测量精度有限、无法确定真实锥点空间位置等不足，本发明提供一种快速、准确、可以确定真实锥点空间位置信息的圆锥运动测量方法，包括：
7.空间运动信息到平面运动信息的转化：通过投影将stewart平台的空间运动转化为三个激光点的平面运动，实现了六自由度的物理解耦，简化了数学模型；
8.高对比度特征标志运动序列图像的采集：调节外部实验环境光源以提高三个激光点与背景间的对比度，通过一台摄像机获得含三个激光点的平面运动序列图像；
9.三个激光点中心点的亚像素提取：利用边缘提取方法获得三个激光点的边缘点像素坐标，通过最小二乘拟合边缘点获得三个激光点中心点的亚像素坐标，利用摄像机确定的图像像素坐标与世界坐标的对应关系将亚像素坐标转换为相应的世界坐标，结合三束激光的空间位置关系，获得三束激光交点的世界坐标；
10.数学模型的建立：建立多个坐标系，基于测量装置中各部件的空间位置关系，通过
坐标系转换建立空间运动投影为平面运动的数学模型，数学公式表达如下：
[0011][0012]
其中，p为特征点坐标值；r为旋转矩阵；t为平移矩阵；下标为原始坐标系，上标为目标坐标系，如
srw
为世界坐标系{w}到背投幕坐标系{s}的旋转矩阵，sp为特征点在背投幕坐标系{s}下的坐标值。
[0013]
由于世界坐标系{w}平行于背投幕坐标系{s}，故对式(1)中的两个式子进行联立可得：
[0014]wtm＝st
l-wrmm
t
l-s
tw(2)
[0015]
其中，wtm为动平台坐标系{m}相对于世界坐标系{w}的平移矩阵；st
l
可根据三个激光点在背投幕坐标系{s}下的坐标值和三束激光的物理位置关系求解获得；mt
l
为投点器坐标系{l}的坐标原点在动平台坐标系{m}的坐标值，由于投点器固定于stewart平台上，故mt
l
为一定值矩阵，进而可得；stw为所求的初始状态下动平台坐标系{m}的原点在投点器坐标系{l}下的坐标值。
[0016]
由于mt
l
中包含stw的信息，对其分解可得：
[0017]mt
l
＝st
l
(0)-s
tw(3)其中，st
l
(0)为初始时刻下，投点器坐标系{l}相对于背投幕坐标系{s}的平移矩阵。
[0018]
将式(3)代入式(1)可得：
[0019]wtm＝st
l-wrms
t
l
(0) (
wrm-i)stw(4)
[0020]
由于det(
wrm-i)＝0，故在此需借用伪逆来求得stw。由于伪逆求得的解为通解，为了确定唯一解，本专利通过stewart平台旋转两个不同的位姿获得两组式(4)，进而求得stw。
[0021]
传统stewart平台圆锥运动测量中，通常默认动平台坐标系原点(即圆锥运动的实际锥点)与动平台圆心重合，未考虑加工安装过程中以及控制引入的误差。本发明通过引入背投幕坐标系{s}和投点器坐标系{l}，可通过式(4)实现圆锥运动实际锥点空间位置的获取。
[0022]
实际锥点空间位置信息的获取：获得两组stewart平台处于不同位姿下的运动序列图像，通过图像处理方法将获得的三个激光点中心点和三束激光交点的世界坐标代入数学模型获得两个方程，采用svd方法通过求伪逆矩阵获得实际锥点的空间位置信息。
[0023]
圆锥运动的解算：获得stewart平台做圆锥运动的序列图像，通过图像处理方法将获得的三个激光点中心点和三束激光交点的世界坐标代入含实际锥点空间位置信息的数学模型，求解得到stewart平台的圆锥运动信息。
[0024]
本发明圆锥运动测量方法具有如下优势：
[0025]
(1)本发明通过将锥点信息列入数学模型中，通过解算实际锥点信息实现高精度的圆锥运动测量。
[0026]
(2)本发明方法测量步骤简便、计算量小、系统成本低，可同时适用于不同频率与运动范围的圆锥运动测量。
[0027]
(3)本发明方法属于空间运动测量方法，能够实现一定频率范围内的高精度空间运动测量。
附图说明
[0028]
附图1为一种基于机器视觉的圆锥运动测量流程图；
[0029]
附图2为基于机器视觉的圆锥运动解耦测量流程图；
[0030]
附图3-4为本发明方法具体仿真实例对圆锥运动的测量结果图。
具体实施方式
[0031]
为解决现有测量方法对圆锥运动测量存在系统复杂、成本高、未考虑实际运动锥点信息等问题，本发明提供了一种基于机器视觉的圆锥运动测量方法，本发明方法通过建立含实际运动锥点信息的解耦数学模型实现了实际运动锥点信息的求解以及圆锥运动的高精度测量，下面结合附图和具体的实施实例对本发明做出详细描述。
[0032]
参考图1为一种基于机器视觉的圆锥运动测量流程图。本发明测量方法主要包括以下步骤：
[0033]
步骤s1：投点器固定于stewart平台动平台上，投射三束互相垂直的激光束于背投幕上，摄像机采集含三个激光点的运动序列图像；
[0034]
步骤s2：序列图像在三个激光中心点的亚像素提取，其包括：三个激光点的边缘点像素提取，最小二乘拟合边缘点像素获得三个激光中心点的亚像素坐标值，基于坐标变换的激光中心点的世界坐标求解；
[0035]
步骤s3：根据三束激光的物理位置关系建立空间运动信息投影到平面运动信息的物理解耦模型；
[0036]
步骤s4：实际运动锥点位置信息求解，其包括：通过stewart平台的两个不同位姿获得两组基于s3中建立的数学模型的方程，利用svd求得实际运动锥点的空间位置坐标值，将其代入更新数学模型；
[0037]
步骤s5：圆锥运动的解耦测量：对获得的基于stewart平台圆锥运动的三个激光点平面运动序列图像进行图像处理得到相关激光中心点坐标值，将该信息代入数学模型求解得到stewart平台的圆锥运动信息；
[0038]
步骤s6：将获得的运动信息进行显示保存。
[0039]
参考图2为基于机器视觉的圆锥运动解耦测量流程图。本发明圆锥运动解耦测量方法包括如下步骤：
[0040]
步骤s11：读入采集的含三个激光点的平面运动序列图像；
[0041]
步骤s12：利用canny算法提取激光边缘点的像素坐标；
[0042]
步骤s13：基于最小二乘原理拟合激光边缘点获得激光中心点的亚像素坐标；
[0043]
步骤s14：通过摄像机标定确定的图像像素坐标与世界坐标之间的对应关系将获得的激光中心点亚像素坐标转换为相应的世界坐标；
[0044]
步骤s15：根据三束激光的相对位置关系获得三束激光交点的世界坐标；
[0045]
步骤s16：将三个激光点及其交点的空间坐标信息代入含实际锥点空间位置信息的数学模型，求解可得stewart平台的圆锥运动信息。
[0046]
为验证本发明所提方法的可行性，利用matlab实现了stewart平台圆锥运动的仿真，同时实现了三束互相垂直且运动状态与stewart平台一致的激光束，以及三束激光束投影于同一平面上形成的三个激光点的平面运动的仿真。
[0047]
本发明利用四元数法实现matlab对圆锥运动的仿真，并根据本发明所提解耦模型对该运动信息进行求解。设定q(t)为(cos(theta/2)，sin(theta/2)cos(w*t)，sin(theta/2)cos(w*t)，0)，其中theta＝3；w＝2*pi；实际锥点位置为(-2，-1，4)。
[0048]
参考图3为未计算实际锥点位置，即默认锥点位置为(0，0，0)时获得的stewart平台运动信息。其中图3(a)为锥点位置的空间坐标值与时间的关系曲线；图3(b)为q(t)各参数与时间的关系曲线图。由图可知，在未考虑实际锥点位置与默认锥点位置的误差时，求得的q(t)各参数与设置值相同，锥点位置在(-2，-1，4)附近存在平移，与实际情况不符。
[0049]
参考图4为计算实际锥点位置并补偿后获得的stewart平台运动信息。其中图4(a)为锥点位置的空间坐标值与时间的关系曲线；图4(b)为q(t)各参数与时间的关系曲线图。由图可知，在考虑实际锥点位置与默认锥点位置的误差时，求得的q(t)各参数与设置值相同，锥点位置不存在平移，与实际情况相符。
[0050]
上述描述为本发明实施仿真的详细介绍，其并非用于对本发明作任何形式上的限定。本领域相关技术人员可在本发明的基础上可做出一系列的优化、改进及修改等。因此，本发明的保护范围应由所附权利要求来限定。