基于角度约束的目标位姿测量二义性剔除方法

陈至坤, 胡连军, 王一, 王福斌

陈至坤, 胡连军, 王一, 王福斌. 基于角度约束的目标位姿测量二义性剔除方法[J]. 应用光学, 2018, 39(1): 107-111. DOI: 10.5768/JAO201839.0103005
引用本文: 陈至坤, 胡连军, 王一, 王福斌. 基于角度约束的目标位姿测量二义性剔除方法[J]. 应用光学, 2018, 39(1): 107-111. DOI: 10.5768/JAO201839.0103005
Chen Zhikun, Hu Lianjun, Wang Yi, Wang Fubin. Solution of duality in target pose measurement based on angle constraint[J]. Journal of Applied Optics, 2018, 39(1): 107-111. DOI: 10.5768/JAO201839.0103005
Citation: Chen Zhikun, Hu Lianjun, Wang Yi, Wang Fubin. Solution of duality in target pose measurement based on angle constraint[J]. Journal of Applied Optics, 2018, 39(1): 107-111. DOI: 10.5768/JAO201839.0103005

基于角度约束的目标位姿测量二义性剔除方法

基金项目: 

国家自然科学基金青年科学基金项目 51505125

详细信息
    作者简介:

    陈至坤(1961-),男,河北景县人,博士,教授,主要从事机器视觉技术及应用等研究工作。E-mail:zkchen@ncst.edu.cn

    通讯作者:

    胡连军(1991-),男,河北唐山人,硕士研究生,主要从事机器视觉和图像处理等技术研究工作。E-mail:hulianjun0910@163.com

  • 中图分类号: TN209; TP242

Solution of duality in target pose measurement based on angle constraint

  • 摘要: 为了有效解决单圆特征目标位姿解存在二义性的问题,提出了基于角度约束的目标位姿虚假解的消除方法。在相机标定好的前提下,在水平面上平移相机系统获得两幅或两幅以上具有圆特征的目标物图像,以圆形特征目标物的真实姿态角在相机坐标系下保持不变作为约束,可以有效剔除虚假解。可将该方法应用于末端安装摄像机的工业机器人,操控机器人做已知的平移运动从而有效剔除圆特征目标位姿的虚假解。通过实验验证,圆特征目标姿态角的绝对误差小于0.5°,然后可通过真实姿态选出对应目标的真实位置。该方法简单易行,不需要额外的高昂设备就能精确地定位出物体的真实位姿,成功率可达100%。
    Abstract: In order to solve duality in pose estimation of single circle feature, a method for eliminating the false pose of the target pose based on angle constraint is proposed. Under the premise of camera calibration, two or more images of circular target are obtained by translating the camera system on a horizontal plane. Based on the nature that real attitude angle of circular target remains unchanged in the camera coordinate system, the false solution can be effectively eliminated. This method can be applied to the industrial robot with a camera installed at the end of the robot, the false solution can be eliminated by controlling the robot to do the known translational motion. Experimental results show that the absolute error of the attitude angle is less than 0.5°, and the true position of the corresponding target is selected by the real attitude. The method is simple and easy to operate, which can accurately locate the true position of the object without additional high equipment. The success rate can reach 100%.
  • 超连续谱光源在光纤传感、光谱测量、大气探测和生物医疗等领域得到了广泛的应用[1-6],基于光纤的超连续谱光源具有超宽带、高光谱功率和高光束质量等特点而被广泛研究。通常来讲,超连续谱光源主要包括2个部分,具有高功率的脉冲激光器和高非线性光纤。微结构光纤和硅基单模光纤均可以用来产生超连续谱[7-9],然而微结构光纤与泵浦激光器尾纤的耦合仍然是一项挑战。相比于微结构光纤,固态单模光纤与泵浦激光器的输出端能进行低损耗熔接,具有结构紧凑、系统高效的特点。此外,泵浦激光器也是产生超连续谱的关键部分。常用的泵浦激光器为脉冲激光器,锁模光纤激光器已经被证明能产生各种类型的脉冲,如常规孤子脉冲、耗散孤子脉冲和类噪声脉冲等。基于类噪声脉冲的锁模光纤激光器已经被证明在泵浦非线性光纤中产生超连续谱具有独特的优势。类噪声脉冲在频谱上表现出超宽带的特性,相比于传统脉冲,类噪声脉冲能更有效地实现非线性频率转换[10- 11]。此外,类噪声脉冲还具有高的峰值功率,有利于产生超连续谱。

    目前,基于类噪声脉冲的抽运非线性光纤产生超连续谱的实验已经被大量报道[12-16]。2012年J. C. HernandezGarciaa等[12]将获得的类噪声脉冲在腔外放大后泵浦0.75 km长的单模光纤得到的超连续谱范围是1.5 μm~1.75 μm,并且在1 640 nm~1 750 nm范围内光谱的不平坦度≤±1 dB。2013年Alexey Zaytsev等[13]利用ps级的类噪声脉冲泵浦长100 m的单模光纤,得到了1 050 nm~1 250 nm的平坦超连续谱,但其结构较为复杂。2014年Shih-Shian Lin等[14]报道了基于掺铒光纤放大器和高非线性光纤的超连续谱光源,相应的光谱范围为1.2 μm~2.1 μm,虽然光谱的范围较宽,但光谱不平坦。2015年Chen等[15]利用类噪声脉冲泵浦非线性光纤获得了500 nm~2 300 nm范围的超连续谱,在700 nm~1 500 nm范围内光谱的平坦度优于5 dB。2017年E. Hernández-Escobar等[16]报道了由功率放大的类噪声脉冲泵浦非线性光纤获得了超连续谱,超连续谱的覆盖范围为1 261 nm~2 261 nm,其光谱的平坦度为3 dB。在以上报道中,由类噪声脉冲泵浦非线性光纤获得的超连续谱的平坦度在3 dB以上,但获得平坦度高的超连续谱时结构又较复杂。高平坦度的超连续谱光源可以更好地满足光纤传感、光纤通信等领域的应用。因此,结构简单、紧凑,并且平坦度高的超连续谱光源值得研究。

    本文提出了一种由类噪声脉冲抽运的平坦超连续谱光源。在泵浦功率为450 mW时,实现了中心波长为1 600 nm的类噪声锁模脉冲输出,尖峰脉宽宽度为303 fs,3 dB光谱宽度为63.34 nm。利用掺铒光纤放大器将其谐振腔输出功率放大至338 mW,并且类噪声脉冲的光谱没有明显的变化。将功率放大后的类噪声脉冲耦合进一段长57 m的高非线性光纤,获得的超连续谱覆盖了1 530 nm~2 300 nm,超连续谱的最大输出功率为49.83 mW。其中,在1 736 nm~2 134 nm光谱范围内,光谱的平坦度优于0.5 dB。

    基于类噪声脉冲抽运全光纤超连续谱产生的实验结构如图1所示。由类噪声脉冲种子源、掺铒光纤放大器和一段高非线性光纤(HNLF)组成,其中类噪声脉冲种子源是基于非线性偏振旋转原理实现锁模的。由2个偏振控制器(PC1和PC2)和偏振相关隔离器(PD-ISO)组成重要的锁模器件,其中,PD-ISO还能保证光脉冲在环形腔内单向传输。工作波长为980 nm的半导体激光器(LD)通过波分复用器(WDM)泵浦一段长0.8 m的高掺杂掺铒光纤(EDF),耦合比为10:90的光纤耦合器的90%端用于腔内反馈,10%端用来输出脉冲。环形腔内加入长为1 m的色散补偿光纤(DCF)来控制腔内色散,使腔内净色散接近零色散;同时加入6 m色散位移光纤(DSF),用来增大腔长和增强非线性。腔内其他无源器件的尾纤均为SMF-28,尾纤长度估计为6.24 m,总腔长为14.04 m。在1.5 μm波段,SMF-28、DSF、DCF和EDF的色散值分别为−0.022 9 ps2/m、−0.005 1 ps2/m、+0.184 8 ps2/m和−0.02 ps2/m,因此,经过计算的环形腔的净色散为−0.0047 ps2/m,处于近零反常色散区,有利于孤子自频移等非线性效应的发生。

    图  1  基于类噪声脉冲抽运的全光纤超连续谱实验结构
    Figure  1.  Experimental structure diagram of all-fiber super-continuum spectrum based on noise-like pulse pumping

    由于超连续谱的产生存在阈值,因此,为了避免种子脉冲的输出功率达不到阈值,在激光器输出端搭建了掺铒光纤放大器。掺铒光纤放大器包括LD(Pump2)、2 m掺铒光纤(EDF2)、WDM2以及隔离器(ISO),ISO的隔离损耗为33 dB,采用背向泵浦的方式来提高泵浦效率,在放大器的输出端熔接一段HNLF来产生超连续谱。实验过程中采用最高分辨率为0.05 nm的光谱分析仪(YOKOGAWA AQ6375)测量光谱,时域信号由10 Gb/s光电探测器和2.5 GS/s示波器(OSC Agilent DSO9254A)来监测,采用自相关仪(femtochrome,FR-103XL)观测锁模脉冲的自相关轨迹。

    在实验中,通过调节抽运泵浦功率和偏振控制器,在泵浦功率为450 mW时出现了稳定的类噪声脉冲锁模,此时的输出功率约为3.13 mW,类噪声脉冲的光谱如图2(a)所示。从图2(a)可看出,光谱较平滑,和报道的类噪声脉冲光谱相似。类噪声脉冲的中心波长为1 600 nm,3 dB光谱宽度为63.34 nm。示波器观测的脉冲序列如图2(b)所示,脉冲的幅度基本均匀一致,脉冲间隔为71.22 ns,对应的重复频率为14.24 MHz,与14.04 m的腔长相对应。为了进一步确定是类噪声脉冲锁模,测量的自相关轨迹如图2(c)所示。图2(c)中插图为大范围的自相关轨迹,一个窄的尖峰位于一个大的基底上,这是典型的类噪声脉冲自相关轨迹,由一系列随机相位、强度和脉冲宽度的超短脉冲组成的脉冲包络。对尖峰采用高斯曲线拟合,相应的尖峰脉宽宽度为303 fs。类噪声脉冲的频谱图如图2(d)所示,信噪比为46 dB,其中插图为400 MHz范围的频谱图,频谱没有调制,表明类噪声脉冲锁模稳定。

    图  2  类噪声脉冲锁模
    Figure  2.  Noise-like pulse mode locking

    在获得类噪声脉冲锁模后,将泵浦功率增加至1 000 mW,类噪声脉冲仍能保持稳定的单脉冲运行。图3给出了不同泵浦功率下类噪声脉冲的输出光谱。从图3(a)可看出泵浦功率从450 mW增加至1 000 mW过程中,光谱的形状基本保持不变,而光谱的强度随着泵浦功率的增加有轻微的增加。此外,不同泵浦功率下,类噪声脉冲的自相关轨迹如图3(c)所示,与图2(c)中插图的形状非常相似,在基底上有一个尖峰,尖峰的宽度保持在303 fs没有改变。图3(b)显示了类噪声脉冲光谱的3 dB宽度随泵浦功率的变化。从图3(b)中可以看出,光谱宽度与泵浦功率之间呈线性关系。在泵浦功率达到最大1 000 mW时,类噪声脉冲的3 dB光谱宽度能达到69.66 nm。

    图  3  类噪声脉冲输出特性
    Figure  3.  Noise-like pulse output characteristics

    由于谐振腔的最大输出功率为8.6 mW,无法直接泵浦高非线性光纤,需要进行功率放大,为此设计了掺铒光纤放大器结构。为了确定类噪声脉冲经过掺铒放大器时光谱没有较大的变化,给出了种子脉冲经放大器放大后的光谱对比,如图4所示。图4中黑色虚线为没有经过放大的类噪声脉冲光谱,红色实线为经过放大后测得的类噪声脉冲光谱。从图4中可以看出,光谱强度增加,但是光谱没有较大的改变,说明光脉冲在放大过程中没有明显的非线性效应。图5给出了放大器的输出功率随泵浦功率的变化。从图5中可以看出,随着泵浦功率的增加,掺铒放大器的斜率有缓慢下降的趋势。当放大器的泵浦功率为1 000 mW时,放大器的最大输出功率为338 mW。由于泵浦2的最大功率为1 000 mW,因此,不能获得更高的输出功率。

    图  4  类噪声脉冲放大前后的光谱对比
    Figure  4.  Comparison of spectrum before and after noise-like pulse amplification
    图  5  放大器输出功率随泵浦功率变化
    Figure  5.  Amplifier output power varies with pump power

    将长为57 m的HNLF与放大器的输出端熔接可产生超连续谱。使用的HNLF在1 550 nm处非线性系数估计为10 W−1 km−1,截止波长为1 480 nm,此外HNLF的零色散波长也是1 550 nm。由于类噪声脉冲包络中飞秒脉冲的峰值功率较高,在高非线性光纤中受非线性效应影响使光谱展宽,如图6(a)所示。从图6(a)可看出,在泵浦2的功率为300 mW时,受到四波混频(FWM)和光孤子效应的作用,在HNLF的零色散波长附近光谱会急剧展宽;扩展到反常色散区的光谱在自相位调制和反常色散的作用下形成了高阶孤子。进一步提高泵浦功率,脉冲的峰值功率会超过受激拉曼散射的阈值,在受激拉曼效应的作用下会发生孤子自频移,导致光谱向更长的波长范围扩展。随着泵浦功率的进一步提高,光谱宽度会更宽[17]。从图6(a)可知,超连续谱覆盖范围为1 530 nm~2 300 nm。随着泵浦功率的增加,超连续谱的光谱强度有所增加,但是整体范围变化不明显,光谱截止在2 300 nm,这是由于光纤的非线性效应和石英玻璃光纤对2 300 nm以上的中红外波段具有很强的吸收损耗。光谱的10 dB宽度范围从1 547 nm~2 182 nm,宽度为634 nm。值得注意的是,在1 736 nm~2 084 nm范围内,光谱的不平坦度≤±0.5 dB,在1 562 nm处尖峰是由于泵浦光没有被充分吸收所致。此外,在1 400 nm和1 900 nm处光谱存在缺陷,这是HNLF中水吸收引起的。图6(b)给出了超连续谱的输出功率和10 dB带宽随放大器功率的变化,超连续谱的输出功率呈线性增加,其最大输出功率为49.83 mW,超连续谱的10 dB也随泵浦功率的增加而增加,最大带宽为639 nm。

    图  6  超连续谱和输出功率以及带宽
    Figure  6.  Output power and bandwidth of super-continuum spectrum

    设计了一个由类噪声脉冲抽运的全光纤结构的超连续谱光源。利用DCF和DSF控制腔内色散,提高非线性效应,在近零负色散区通过调节PCs和泵浦功率实现了类噪声脉冲锁模。类噪声脉冲的中心波长为1 600 nm,3 dB光谱宽度为69.66 nm,重复频率为14.04 MHz,脉冲尖峰宽度为303 fs。然后将此类噪声脉冲的直接输出功率放大,光谱没有明显的变化。将功率放大后的类噪声脉冲注入到一段长57 m的HNLF光纤中,实现了宽带的超连续谱,20 dB光谱范围覆盖了1 530 nm~2 300 nm,超连续谱的10 dB宽度为639 nm。此外,在1 736 nm~2 134 nm范围内光谱的平坦度优于0.5 dB。设计的结构简单、平坦的超连续谱光源在光传感、光通信和光谱学等领域具有较大的潜在应用价值。

  • 图  1   空间圆位姿定义

    Figure  1.   Definition of position and orientation of space circle

    图  2   圆形位姿测量模型

    Figure  2.   Circular pose measurement model

    图  3   二义性消除模型

    Figure  3.   Duality elimination model

    图  4   目标图像处理过程

    Figure  4.   Processing procedure of target image

    表  1   测量实验结果

    Table  1   Experiment results of measurement

    Pose1/° Pose2/°
    图 1 (16.29 1.95 0) (9.64 9.30 0)
    图 2 (15.66 2.03 0) (26.00 1.63 0)
    图 3 (16.34 2.04 0) (26.59 9.44 0)
    图 4 (15.58 1.96 0) (31.65 7.20 0)
    图 5 (15.56 2.13 0) (20.53 3.99 0)
    真实姿态角度 (16.00 2.00 0)
    下载: 导出CSV

    表  2   平移误差

    Table  2   Translation error

    相机坐标系下物体位置/mm 相机底座在坐标纸中的位置/mm
    图 1 (-22.01 -11.30) (30 10)
    图 2 (0.71 18.03) (50 40)
    图 3 (-21.13 19.08) (30 40)
    图 4 (9.91 27.69) (60 50)
    图 5 (-10.96 8.74) (40 30)
    下载: 导出CSV
  • [1] 赵连军.基于目标特征的单目视觉位置姿态测量技术研究[D].北京: 中国科学院大学, 2014.

    ZHAO Lianjun.Research on mono-vision pose measurement based on features of target[D].Beijing: University of Chinese Academy sciences, 2014.

    [2]

    WOLFE W J, MATHIS D, SKLSIR C W, et al.The perspective view of three points[J].IEEE, Trans on Pattern Analysis and Machine Intelligence, 1991, 13(1):66-73. doi: 10.1109/34.67632

    [3]

    CHEN C S, CHANG W Y.On pose recovery for generalized visual sensors[J].IEEE, Trans on Pattern Analysis and Machine Intelligence, 2004, 26(7):848-861. doi: 10.1109/TPAMI.2004.34

    [4] 陈至坤, 徐傲, 王福斌, 等.基于单目视觉和圆形结构光的目标姿态测量方法[J].应用光学, 2016, 37(5):680-685.

    CHEN Zhikun, XU Ao, WANG Fubin, et al.Pose measurement of target based on monocular vision and circle structured light[J].Journal of Applied Optics, 2016, 37(5):680-685.

    [5] 高学海, 徐科军, 张瀚, 等.基于单目视觉和激光测距仪的位姿测量算法[J].仪器仪表学报, 2007, 28(8):1479-1485. doi: 10.3321/j.issn:0254-3087.2007.08.024

    GAO Xuehai, XU Kejun, ZHANG Han, et al.Position-pose measurement algorithm based on single camera and laser range -finder[J].Chinese Journal of Scientific Instrument, 2007, 28(8):1479-1485. doi: 10.3321/j.issn:0254-3087.2007.08.024

    [6] 赵汝进, 张启衡, 左颢睿, 等.一种基于直线特征的单目视觉位姿测量方法[J].光电子·激光, 2010(6):894-897. http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=gdzjg201006024

    ZHAO RuJin, ZHANG Qiheng, ZUO Haorui, et al.A mono-vision method of measuring pose based on line features[J].Journal of Optoelectronics and Laser, 2010(6):894-897. http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=gdzjg201006024

    [7] 吕耀文, 王建立, 王昊京, 等.应用抛物线运动估计摄像机姿态[J].光学精密工程, 2014, 22(4):1078-1085. http://d.old.wanfangdata.com.cn/Periodical/gxjmgc201404036

    LU Yaowen, WANG Jianli, WANG Haojing, et al.Estimation of camera poses by parabolic motion[J].Optics and Precision Engineering, 2014, 22(4):1078-1085. http://d.old.wanfangdata.com.cn/Periodical/gxjmgc201404036

    [8] 张磊, 徐科军, 赵锐, 等.一种基于圆特征的单目视觉位姿测量算法的改进[J].合肥工业大学学报, 2009, 32(11):1669-1673. doi: 10.3969/j.issn.1003-5060.2009.11.010

    ZHANG Lei, XU Kejun, ZHAO Rui, et al.Improvement of position and oriention measurement algorithm of monocular vision based on circle features[J].Journal of Hefei University of Technology, 2009, 32(11):1669-1673. doi: 10.3969/j.issn.1003-5060.2009.11.010

    [9]

    SAFAEERAD R, TCHOUKANOV I, SMITH K C, et al.Three-dimensional location estimation of circular features for machine vision[J].IEEE Transactions on Robotics & Automation, 1992, 8(5):624-640. http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=535380f4668dfd65fecfc6e0b3590779

    [10] 苗锡奎, 朱枫, 丁庆海, 等.基于星箭对接环部件的飞行器单目视觉位姿测量方法[J].光学学报, 2013, 33(4):115-123. http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=gxxb201304018

    MIAO Xikui, ZHU Feng, DUBG Qinghai, et al.Monocular vision pose measurement based on docking ring component[J].Acta Optica Sinica, 2013, 33(4):115- 123. http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=gxxb201304018

    [11] 魏振忠, 赵征, 张广军.空间圆姿态识别二义性的角度约束消除[J].光学精密工程, 2010, 18(3):685-691. http://d.old.wanfangdata.com.cn/Periodical/gxjmgc201003024

    WEI Zenzhong, ZHAO Zheng, ZHANG Guangjun.Solution of duality in pose estimation of single circle using Euclidean angular constraint[J].Optics and Precision Engineering, 2010, 18(3):685-691. http://d.old.wanfangdata.com.cn/Periodical/gxjmgc201003024

  • 期刊类型引用(0)

    其他类型引用(2)

图(4)  /  表(2)
计量
  • 文章访问数:  868
  • HTML全文浏览量:  269
  • PDF下载量:  136
  • 被引次数: 2
出版历程
  • 收稿日期:  2017-01-02
  • 修回日期:  2017-06-12
  • 刊出日期:  2017-12-31

目录

/

返回文章
返回