【申请号：200710117999.8；专利权人：中国科学院自动化研究所；发明人：徐德、谭民、沈扬、李原】
1 ．一种视觉测量装置，其特征在于，左摄像机（ 1 ）、左支架（ 2 ）、左连杆（ 3 ）、同步带（ 4 ）、左带轮（ 5 ）、右摄像机（ 6 ）、右支架（ 7 ）、右连杆（ 8 ）、步进电机（ 9 ）、安装板（ 10 ）、换向带轮 ( 11 ）、右带轮（ 12 ）、张紧轮（ 13 ）、驱动带轮（ 14 ）和图像同步采集卡（ 15 ) ；两台摄像机分别安装在左支架（ 2 ）和右支架（ 7 ）上，左支架（ 2 ）和右支架（ 7 ）分别安装在左连杆（ 3 ）和右连杆（ 8 ）的顶端，左连杆（ 3 ）和右连杆（ 8 ）分别通过轴承安装在安装板（ 10 ）上，左连杆（ 3 ) 的底端装有左带轮（ 5 ) ，右连杆（ 8 ）的底端装有右带轮（ 12 ) ；步进电机（ 9 ）通过螺钉安装在安装板（ 10 ）上，步进电机（ 9 ）的输出轴上装有驱动带轮（ 14 ) ，左带轮（ 5 ）的旁边装有换向带轮（ 11 ）和张紧轮（ 13 ) ；通过双面齿同步带（ 4 ) ，将左带轮（ 5 ）、右同步轮（ 12 ）、换向带轮 ( 11 ）、张紧轮（ 13 ）、驱动带轮（ 14 ）联结在一起；换向带轮（ 11 ）固定安装在安装板（ 10 ）上，张紧轮（ 13 ）在安装板（ 10 ）上，调整位置的张紧轮（ 13 ）将双面齿同步带（ 4 ）张紧；两台摄像机的视频信号端通过同轴电缆接至图像同步采集卡（ 15 ）其中的两路视频信号输入端。
2 ．一种视觉测量方法，其特征在于，包括步骤：
A ．在初始状态下，两台摄像机光轴中心线处于平行状态；
B ．测量时，利用步进电机驱动两台摄像机同步相向转动两次，用于实现两台摄像机对被测目标的跟踪，得到摄像机对准被测目标时相对于初始状态的转角；
C ．分别使被测目标的图像横坐标处于跟踪的摄像机所采集图像的中心区域；
D ．根据两台摄像机分别跟踪被测目标时的转角，以及被测目标在两台摄像机图像中的坐标，计算出被测目标的三维坐标；
其中第一台摄像机的跟踪测量包括：
第一台摄像机将跟踪被测目标的图像横坐标调整到该摄像机所采集图像的中心区域，记录步进电机的脉冲数，并转换为第一台摄像机的转角 Q , ;
记录被测目标在第二台摄像机中的图像坐标，计算出该图像坐标与图像中心点的坐标之差（ uZd , vZd ) ;
其中第二台摄像机跟踪测量包括：
第二台摄像机跟踪被测目标，将被测目标的图像横坐标调整到该摄像机所采集图像的中心区域；记录步进电机的脉冲数，并转换为第二台摄像机的转角 QZ ;
记录被测目标在第一台摄像机中的图像坐标，计算出该图像坐标与图像中心点的坐标之差（ uld , vld ) ; 所述被测目标的目标点 P 在坐标系｛ H ｝中的三维坐标（ xh , yh , Zh ）的计算包括如下：
其中， D 是两台摄像机之间的距离， Q ，和 QZ 是两台摄像机跟踪目标时的转角， ( p , d , vld ）是第二台摄像机跟踪目标时第一台摄像机中的图像坐标与图像中心点的坐标之差， ( p Zd , vZd ）是第一台摄像机跟踪目标时第二台摄像机中的图像坐标与图像中心点的坐标之差；
所述三维坐标测量结果以两台摄像机中点位置为参考坐标系的原点，以两台摄像机之间的连线作为参考坐标系的 X 轴，以两台摄像机之间的连线的中垂线作为参考坐标系的 Z 轴。
3 ．根据权利要求 2 所述的装置，其特征在于，所述步进电机（ 9 ）到左摄像机（ 1 ）和右摄像机（ 6 ）的传动比均为 2 : 1 。
发明内容
为了解决现有技术摄像机自标定方法，利用环境的特定约束如平行线，或者利用机器人的特定运动，不具有通用性的问题，本发明的目的在于提供一种不依赖于摄像机参数的视觉测量方法及装置。
为实现上述目的，本发明的第一方面，提供视觉测量方法的技术方案：
包括步骤：
A ．分别使被测目标的图像横坐标处于跟踪的摄像机所采集图像的中心区域；
B ．根据两台摄像机分别跟踪被测目标时的转角，以及被测目标在两台摄像机图像中的坐标，计算出被测目标的三维坐标。
C ．在初始状态下，两台摄像机光轴中心线处于平行状态；
D ．测量时，利用步进电机驱动两台摄像机同步相向转动两次，用于实现两台摄像机对被测目标的跟踪，得到摄像机对准被测目标时相对于初始状态的转角；
所述第一台摄像机的跟踪测量包括：
第二台摄像机跟踪被测目标，将被测目标的图像横坐标调整到该摄像机所采集图像的中心区域；记录步进电机的脉冲数，并转换为第二台摄像机的转角 QZ ;
记录被测目标在第一台摄像机中的图像坐标，计算出该图像坐标与图像中心点的坐标之差（ uld , vld ）。
所述三维坐标测量结果以两台摄像机中点位置为参考坐标系的原点，以两台摄像机之间的连线作为参考坐标系的 X 轴，以两台摄像机之间的连线的中垂线作为参考坐标系的 Z 轴。
第一台摄像机将跟踪被测目标的图像横坐标调整到该摄像机所采集图像的中心区域，记录步进电机的脉冲数，并转换为第一台摄像机的转角 Q , ;
记录被测目标在第二台摄像机中的图像坐标，计算出该图像坐标与图像中心点的坐标之差（ uZd , vZd ）。
所述第二台摄像机跟踪测量包括：
所述被测目标的目标点 P 在坐标系｛ H ｝中的三维坐标（ Xh , yh , Zh ）包括如下：
其中， D 是两台摄像机之间的距离，。，和。 2 是两台摄像机跟踪目标时的转角， ( p , d , vld ）是第二台摄像机跟踪目标时第一台摄像机中的图像坐标与图像中心点的坐标之差， ( p Zd , VZd ）是第一台摄像机跟踪目标时第二台摄像机中的图像坐标与图像中心点的坐标之差。
为实现上述目的，本发明的第二方面，提供视觉测量装置的技术方案包括：左摄像机、左支架、左连杆、同步带、左带轮、右摄像机、右支架、右连杆、步进电机、安装板、换向带轮、右带轮、张紧轮、驱动带轮和图像同步采集卡；
所述步进电机到摄像机的传动比为 2 : 1
本发明的积极技术效果或优点：本发明的显著特点是不需要摄像机的内参数和外参数的情况下，利用本发明能够很好地实现视觉三维坐标测量，提高了视觉测量的适应性和可用性，应用方便。
两台摄像机分别安装在左支架和右支架上，左支架和右支架分别安装在左连杆和右连杆的顶端，左连杆和右连杆分别通过轴承安装在安装板上，左连杆的底端装有左带轮，右连杆的底端装有右带轮；步进电机通过螺钉安装在安装板上，步进电机的输出轴上装有驱动带轮，左带轮的旁边装有换向带轮和张紧轮；通过双面齿同步带，将左带轮、右带轮、换向带轮、张紧轮、驱动带轮联结在一起；换向带轮固定安装在安装板上，张紧轮在安装板上的位置可调整，以保证双面齿同步带张紧；两台摄像机的视频信号端通过同轴电缆接至图像同步采集卡其中的两路视频信号输入端。
技术领域
本发明属于机器人领域中的视觉测量，具体地说是用于服务机器人对被操作目标进行三维坐标测量的方法以及用于实现上述方法的装置。
背景技术
为了避免摄像机内参数和外参数的预先标定所带来的不便，通常采用的方法是摄像机自标定。目前的摄像机自标定方法，需要利用环境中的特定约束如平行线（ D . Xu , Y . F . Li , Y . Shen , M . Tan , " New posedetection method for self 一 calibrated cameras based on parallel lines and itsapplication in visual control system , ”工 EEE Transactions on System , Man & Cybernetics 一 PartB : Cybernetics , vol . 36 , no . 5 , pp . 1 104 一 1117 , 2006 ) ，或者利用机器人的特定运动（ 5 . D . Ma , " A Self 一 calibration technique for activevision system , ”工 EEE Transaction on Robotics and Automation , VOI · 12 , no · 1 , pp . 1 14 一 120 , 1996 ) ，不具有通用性。
摄像机本身固有的参数，如焦距、光轴中心点图像坐标、镜头畸变等，称之为摄像机的内参数。摄像机之间的几何关系，即摄像机之间的位置和姿态，称之为摄像机的外参数。目前，机器人领域的三维坐标视觉测量，一般采用由两台摄像机构成的立体视觉系统。它根据目标在两台摄像机中的图像坐标，以及两台摄像机的内参数和外参数，由两条射线的交点计算出目标的三维坐标（其典型结构与原理见“ Milan Sonka 等著，艾海舟等译，图像处理、分析与机器视觉，第 316 一 320 页，北京：人民邮电出版社， 2003 年 9 月”）。其不足之处在于：两台摄像机的内参数和外参数需要预先标定，标定过程繁杂（ 2 . Zhang , " A flexible newtechnique for camera calibration , ”工 EEE Transactions on Pattern Analysisand Machine 工 ntelligence , vol . 22 , no . 11 , pp . 1330 一 1334 , 2000 ) ；视觉测量过程中，两台摄像机的内参数和外参数需要保持不变，一旦摄像机的内参数或者外参数发生变化，需要重新标定。
图 1 为本发明的视觉测量原理示意图。
图 2 为本发明的视觉装置原理图。
具体实施方式
下面结合附图详细说明本发明技术方案中所涉及的各个细节问题。应指出的是，所描述的实施例仅旨在便于对本发明的理解，而对其不起任何限定作用。
本发明的工作原理，简述如下。在两台摄像机之间建立坐标系｛ H } ，如图 1 所示。被测目标点用 P 表示，两台摄像机 1 和摄像机 6 光轴中心点分别用 C ，和 CZ 表示，并假设 Cl 和 cZ 之间的距离为 D 。视觉测量分为两步进行。第一步，利用公知的视觉跟踪技术，使第一台摄像机 1 跟踪被测目标，将被测目标的图像横坐标调整到该摄像机所采集图像的中心区域。记录步进电机的脉冲数，并转换为第一台摄像机 1 的转角 Q ，。记录被测目标在第二台摄像机 6 中的图像坐标，计算出该图像坐标与图像中心点的坐标之差（ uZd , VZd ）。第二步，使第二台摄像机 6 跟踪被测目标，将被测目标的图像横坐标调整到该摄像机所采集图像的中心区域。记录步进电机的脉冲数，并转换为第二台摄像机 6 的转角 QZ 。记录被测目标在第一台摄像机 1 中的图像坐标，计算出该图像坐标与图像中心点的坐标之差（ uld , vld ）。被测目标点 P 在坐标系｛ H ｝中的三维坐标（ xh , yh , Zh ）计算如下：
其中， D 是两台摄像机之间的距离，。，和。 2 是两台摄像机跟踪目标时的转角， ( uld , vld ）是第二台摄像机 6 跟踪目标时第一台摄像机 1 中的图像坐标与图像中心点的坐标之差， ( u Zd , VZd ）是第一台摄像机 1 跟踪目标时第二台摄像机 6 中的图像坐标与图像中心点的坐标之差。
所述三维坐标测量结果以两台摄像机中点位置为参考坐标系的原点，以两台摄像机之间的连线作为参考坐标系的 X 轴，以两台摄像机之间的连线的中垂线作为参考坐标系的 Z 轴。
本实例中：同步带 4 采用 T2 . 5 一 330 型双面齿同步带；左带轮 5 采用 T2 . 5 一 36 ；换向同步轮 H 采用 T2 . 5 一 18 ；右带轮 12 采用 T2 . 5 一 36 ；张紧轮 13 采用 T2 . 5 一 18 ；驱动同步轮 14 采用 T2 . 5 一 18 ；左支架 2 、左连杆 3 、右支架 7 、右连杆 8 无特殊要求，为普通机械件。
首先，利用公知的方法安装和调整本发明如图 2 所示装置上的两台摄像机 1 和 6 , 使两台摄像机 1 和 6 在初始状态下的光轴中心线平行。然后，利用本发明的装置，采用本发明的测量方法，对棋盘图案的交叉点的三维坐标进行了测量。其中，棋盘图案的黑色方块的尺寸为 30 又 30 毫米。摄像机 1 和 6 所采集的图像的尺寸为 640 又 480 像素。
在实施例中，两台摄像机 1 和 6 均采用 SUNHA 的 SH 一 831 微型摄像机或市场上供应的其它型号摄像机，步进电机 9 采用混合式步进电机 39BYG601 或市场上供应的其它型号。实验时，图像采集卡 15 采用 MC 一 30 或市场上供应的其它型号，在任意时刻对两台摄像机 1 和 6 的视觉图像进行同步采集。计算机采用工业控制计算机 ADvANTEcH 一 6 10 。步进电机 9 的步距为 1 . 8 。，从步进电机 9 到摄像机 1 和 6 的传动比均为 2 : 1 ，利用步进电机 9 的驱动器对步进电机 9 的运动进行了 64 细分。因此，计算机每向步进电机 9 发出一个脉冲，摄像机 1 和 6 的转动量为 1 . 8 / 64 / 2 一 1 . 41 又 102 （。）。两台摄像机 1 和 6 之间的距离为 D - 150 毫米。
利用上述交叉点的三维坐标，可以计算出相邻点间的距离，以校验视觉测量结果。下面附表是计算出的水平方向和竖直方向的相邻点之间距离，即经过视觉测量后计算出的黑色方块的宽和高，如下表所示：
黑色方块的实际宽和高都是 30 毫米（ ITlln ) ，上述结果与实际值很接近。上述结果是在不采用摄像机 1 和 6 模型参数的情况下，利用具有严重畸变的微型摄像机 1 和 6 采集图像，针对距离摄像机 500 毫米左右的目标，利用本发明的方法和装置测量获得的。从这些结果可以发现，视觉测量的精度能够满足服务机器人对目标进行抓取等作业的要求。
可见，即使利用大畸变摄像机，在不需要摄像机参数的情况下，利用本发明能够很好地实现视觉三维坐标测量，提高了视觉测量的适应性和可用性。
以上所述，仅为本发明中的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉该技术的人在本发明所揭露的技术范围内，可理解想到的变换或替换，都应涵盖在本发明的包含范围之内，因此，本发明的保护范围应该以权利要求书的保护范围为准。
摘要
本发明公开一种视觉测量方法与装置，解决适应性差的问题。步进电机驱动两台摄像机同步相向转动；并驱动摄像机两次转动，两台摄像机对目标跟踪，使目标图像横坐标处于跟踪摄像机所采集图像的中心区域；根据两次转动的转角、及目标在两台摄像机图像中的坐标，计算目标的三维坐标。两台摄像机安装在左、右连杆顶端的支架上，左、右带轮安装于左、右连杆的底端；步进电机输出轴上装有驱动带轮，左带轮旁边装有换向带轮和张紧轮；通过双面齿同步带，将右带轮、换向带轮、左同步轮、张紧轮、驱动带轮联结在一起。本发明不依赖于摄像机的内参数，故不需要对摄像机的内参数进行标定。本发明应用方便，可以大幅度提高视觉测量的适应性和可用性。
电话：4006-574-123/0574-27834692 传真：0574-27834691
地址：浙江省宁波市鄞州区姜山镇蔡郎桥村姜南路39-2 E-Mail:sales@belt-pulley.com
浙ICP备09102982号 盖奇公司网络部提供技术支持