留言板

尊敬的读者、作者、审稿人, 关于本刊的投稿、审稿、编辑和出版的任何问题, 您可以本页添加留言。我们将尽快给您答复。谢谢您的支持!

姓名
邮箱
手机号码
标题
留言内容
验证码

基于最佳偏振角的线性位姿测量方法研究

王志武 张子淼 许凯 张福民 刘斌

王志武, 张子淼, 许凯, 张福民, 刘斌. 基于最佳偏振角的线性位姿测量方法研究[J]. 红外与激光工程, 2022, 51(3): 20210241. doi: 10.3788/IRLA20210241
引用本文: 王志武, 张子淼, 许凯, 张福民, 刘斌. 基于最佳偏振角的线性位姿测量方法研究[J]. 红外与激光工程, 2022, 51(3): 20210241. doi: 10.3788/IRLA20210241
Wang Zhiwu, Zhang Zimiao, Xu Kai, Zhang Fumin, Liu Bin. Research on linear pose measurement method based on optimal polarization angle[J]. Infrared and Laser Engineering, 2022, 51(3): 20210241. doi: 10.3788/IRLA20210241
Citation: Wang Zhiwu, Zhang Zimiao, Xu Kai, Zhang Fumin, Liu Bin. Research on linear pose measurement method based on optimal polarization angle[J]. Infrared and Laser Engineering, 2022, 51(3): 20210241. doi: 10.3788/IRLA20210241

基于最佳偏振角的线性位姿测量方法研究

doi: 10.3788/IRLA20210241
基金项目: 国家自然科学基金青年科学基金(51605332,51905378);天津市自然科学基金青年项目(19JCQNJC04200,20JCQNJC00360);天津市技术创新引导专项基金企业科技特派员项目(20YDTPJC00450)
详细信息
    作者简介:

    王志武,男,硕士生,主要研究方向为基于视觉图像的位姿测量

    通讯作者: 刘斌,男,副教授,博士,主要从事激光及光电测试技术、视觉检测等方面的研究。
  • 中图分类号: TP391;TH741

Research on linear pose measurement method based on optimal polarization angle

Funds: National Natural Science Foundation of China (youth project)(51605332,51905378);Tianjin Natural Science Foundation(youth project)(19JCQNJC04200,20JCQNJC00360);Tianjin Technological Innovation Guidance Special Fund Enterprise Science and Technology Commissioner Project(20YDTPJC00450)
  • 摘要: 在基于视觉图像的位姿测量中,非线性位姿测量算法的全局收敛存在不确定性,测量结果取决于初值的选取,不能保证位姿测量的鲁棒性。线性位姿测量算法对图像处理的要求比较高,如果定位特征点图像坐标提取不够精确,会导致位姿测量精度降低。在自然光条件下,相机采集定位特征点图像,图像中高亮度区域的存在对定位特征点提取精度产生影响,进而使有效定位特征点数量减少,影响位姿测量精度。针对上述问题,文中提出了一种基于最佳偏振角的线性位姿测量方法:在相机镜头前加装线偏振片,根据Stokes矢量建立偏振片最佳偏振角度求解模型,在使用最佳偏振角度的前提下采集定位特征点图像,提取图像坐标;建立线性位姿求解模型,计算被测物体位姿。实验结果表明,该方法能够有效减少图像中的高亮度区域,改善成像质量,提高线性位姿测量精度,在−60°~+60°的测量范围内,角度测量误差小于±0.16°,在0~20 mm的测量范围内,位移测量误差小于±0.05 mm。
  • 图  1  偏振片角度示意图

    Figure  1.  Schematic diagram of polarizer angle

    图  2  位姿测量模型

    Figure  2.  Pose measurement model

    图  3  位姿测量实验系统

    Figure  3.  Experimental system of pose measurement

    图  4  角点提取实验结果

    Figure  4.  Experimental results of corner points extraction

    图  5  各位置在最佳偏振角条件下采集的图像

    Figure  5.  Images collected at each position on the condition of optimal polarization angle

    图  6  旋转测量实验的平均重投影误差

    Figure  6.  Mean reprojection errors of rotation measurement experiments

    图  7  自然光与最佳偏振角条件下的误差分布图

    Figure  7.  Error distribution of natural light and optimal polarization angle

    图  8  角度测量实验结果

    Figure  8.  Experimental results of angle measurement

    图  9  位移测量实验的平均重投影误差

    Figure  9.  Mean reprojection errors of translation measurement experiments

    图  10  位移测量实验结果

    Figure  10.  Experiment results of displacement measurement errors

    表  1  相机标定实验结果

    Table  1.   Camera calibration experiment results

    Focal lengthfx =3425.60506fy =3426.03573
    Principal pointCx =732.2264Cy =496.46005
    Radial distortionk1=−0.0855k2 =0.8394k3 =−9.7639
    Tangential distortionp1 =0.00023224p2 =0.00023113
    下载: 导出CSV
  • [1] Wang Zhongyu, Li Yaru, Hao Renjie, et al. Monocular vision pose measurement algorithm based on points feature [J]. Infrared and Laser Engineering, 2019, 48(5): 0517002. (in Chinese) doi:  10.3788/IRLA201948.0517002
    [2] Wang Xiangjun, Cao Yu, Zhou Kai. Methods of monocular pose measurement based on planar objects [J]. Optics and Precision Engineering, 2017, 25(1): 274-280. (in Chinese) doi:  10.3788/OPE.20172501.0274
    [3] Lao Dabao, Zhang Huijuan, Xiong Zhi, et al. Automatic measurement method of attitude on monocular vision [J]. Acta Photonica Sinica, 2019, 48(3): 0315001. (in Chinese) doi:  10.3788/gzxb20194803.0315001
    [4] Lei Jinzhou, Zeng Lingbin, Ye Nan. Research on industrial robot alignment technique with monocular vision [J]. Optics and Precision Engineering, 2018, 26(3): 733-741. (in Chinese) doi:  10.3788/OPE.20182603.0733
    [5] Xu Chengyi, Liu Ying, Jia Minping, et al. Method of hand-eye calibration for picking board robot [J]. Transactions of the Chinese Society for Agricultural Machinery, 2019, 50(12): 420-426. (in Chinese) doi:  10.6041/j.issn.1000-1298.2019.12.049
    [6] Zhang Hanxue, Shen Chong, Chen Xuemei, et al. An enhanced fusion strategy for reliable attitude measurement utilizing vision and inertial sensors [J]. Applied Sciences, 2019, 9(13): 1-17. doi:  10.3390/app9132656
    [7] Lu C, Hager G, Mjolsness E. Fast and globally convergent pose estimation from video images [J]. IEEE Transactions on Pattern Analysis and Machine Intelligence, 2000, 22(6): 610-622. doi:  10.1109/34.862199
    [8] Hesch J, Roumeliotis S. A direct least-squares (DLS) method for PnP[C]//IEEE International Conference on Computer Vision, 2011: 383-390.
    [9] Zhang Huijuan, Xiong Zhi, Lao Dabao, et al. Monocular vision measurement system based on EPNP algorithm [J]. Infrared and Laser Engineering, 2019, 48(5): 0517005. (in Chinese) doi:  10.3788/IRLA201948.0517005
    [10] Wang Ping, Zhou Xuefeng, An Aimin, et al. Robust and linear solving method for Perspective-n-Point problem [J]. Chinese Journal of Scientific Instrument, 2020, 41(9): 273-282. (in Chinese)
    [11] Li S, Xu C, Xie M. A robust O(n) solution to the perspective-n-point problem [J]. IEEE Transactions on Pattern Analysis and Machine Intelligence, 2012, 34(7): 1444-1450. doi:  10.1109/TPAMI.2012.41
    [12] Zhu Z, Wang X, Liu Q, et al. Camera calibration method based on optimal polarization angle [J]. Optics and Lasers in Engineering, 2019, 112: 128-135. doi:  10.1016/j.optlaseng.2018.09.009
    [13] 马莉莉. 基于光谱分析与偏振成像的目标识别技术研究[D]. 长春理工大学, 2019.

    Ma Lili. Research on target recognition techniques based on spectrometry analysis and polarization imaging[D]. Changchun: Changchun University of Science and Technology, 2019. (in Chinese)
    [14] 张倩. 基于主动式线偏振光照射的偏振成像实验研究[D]. 电子科技大学, 2020.

    Zhang Qian. Research on polarization imaging with linearly polarized light illumination[D]. Chengdu: University of Electronic Science and Technology of China, 2020. (in Chinese)
    [15] Wang F, Ainouz S, Petitjean C, et al. Specularity removal: A global energy minimization approach based on polarization imaging [J]. Computer Vision and Image Understanding, 2017, 158: 31-39. doi:  10.1016/j.cviu.2017.03.003
    [16] Ainouz S, Morel O, Fofi D, et al. Adaptive processing of catadioptric images using polarization imaging: toward a polacatadioptric model [J]. Optical Engineering, 2013, 52(3): 037001. doi:  10.1117/1.OE.52.3.037001
    [17] Zhu Z, Wang S, Zhang H, et al. Camera–projector system calibration method based on optimal polarization angle [J]. Optical Engineering, 2020, 59(3): 035104. doi:  10.1117/1.OE.59.3.035104
  • [1] 刘峰, 郭英华, 王霖, 高裴裴, 张月桐.  二维主动位姿引导的单目空间姿态测量方法 . 红外与激光工程, 2024, 53(2): 20211026-1-20211026-11. doi: 10.3788/IRLA20211026
    [2] 卢祺, 林婷婷, 李程鹏, 李荣华, 葛研军.  空间非合作目标点云聚类配准方法 . 红外与激光工程, 2021, 50(9): 20200431-1-20200431-10. doi: 10.3788/IRLA20200431
    [3] 张雅鑫, 蒲明博, 郭迎辉, 靳金金, 李雄, 马晓亮, 罗先刚.  基于二次相位超表面的大视场紧凑型全Stokes偏振测量方法 . 红外与激光工程, 2020, 49(9): 20201030-1-20201030-8. doi: 10.3788/IRLA20201030
    [4] 刘岩, 雷柏平, 范斌, 边疆.  基于视觉测量的目标定位技术及结构参数优化 . 红外与激光工程, 2020, 49(S2): 20200191-20200191. doi: 10.3788/IRLA20200191
    [5] 杨凌辉, 张正吉, 林嘉睿, 王金旺, 徐秋宇, 刘博文.  融合光电扫描定位的大构件整体形貌测量方法 . 红外与激光工程, 2019, 48(5): 503002-0503002(8). doi: 10.3788/IRLA201948.0503002
    [6] 王中宇, 李亚茹, 郝仁杰, 程银宝, 江文松.  基于点特征的单目视觉位姿测量算法 . 红外与激光工程, 2019, 48(5): 517002-0517002(8). doi: 10.3788/IRLA201948.0517002
    [7] 张家民, 时东锋, 黄见, 王英俭.  全Stokes偏振关联成像技术研究 . 红外与激光工程, 2018, 47(6): 624001-0624001(8). doi: 10.3788/IRLA201847.0624001
    [8] 黄春晖, 翟晟.  用Stokes参量法研究角锥棱镜的偏振特性 . 红外与激光工程, 2018, 47(8): 818007-0818007(7). doi: 10.3788/IRLA201847.0818007
    [9] 詹翔空, 李政勇, 张伊, 王明宇, 王海洋, 吴重庆.  基于Stocks矢量测量与干涉法的径向偏振光束重建 . 红外与激光工程, 2017, 46(4): 427002-0427002(6). doi: 10.3788/IRLA201746.0427002
    [10] 张旭, 魏鹏.  针对机器人位姿测量立体标靶的单目视觉标定方法 . 红外与激光工程, 2017, 46(11): 1117005-1117005(9). doi: 10.3788/IRLA201746.1117005
    [11] 王天宇, 董文博, 王震宇.  基于单目视觉和固定靶标的位姿测量系统 . 红外与激光工程, 2017, 46(4): 427003-0427003(8). doi: 10.3788/IRLA201746.0427003
    [12] 王鹏, 周权通, 孙长库.  多特征点拓扑确定位姿测量算法研究 . 红外与激光工程, 2017, 46(5): 517001-0517001(9). doi: 10.3788/IRLA201746.0517001
    [13] 陈凤, 朱洁, 顾冬晴, 王盈, 刘玉.  基于激光成像雷达的空间非合作目标相对导航技术 . 红外与激光工程, 2016, 45(10): 1030005-1030005(8). doi: 10.3788/IRLA201645.1030005
    [14] 夏润秋, 王霞, 金伟其, 梁建安, 刘敬.  海面环境中红外偏振成像系统作用距离模型 . 红外与激光工程, 2016, 45(3): 304007-0304007(5). doi: 10.3788/IRLA201645.0304007
    [15] 肖茂森, 李春艳, 吴易明, 陆卫国, 王海霞.  利用新型偏振器件实现方位角测量 . 红外与激光工程, 2015, 44(2): 611-615.
    [16] 郑学汉, 魏振忠, 张广军.  运动目标视觉跟踪测量系统与场地坐标系的快速统一方法 . 红外与激光工程, 2015, 44(7): 2175-2181.
    [17] 颛孙晓博, 武文远, 黄雁华, 龚艳春, 吴成国, 李兆兆.  基于MB模型的简化偏振BRDF模型建立与仿真 . 红外与激光工程, 2015, 44(3): 1098-1102.
    [18] 马军, 张鹰, 邸男, 聂真威.  手眼相机位姿测量精度理论分析及验证 . 红外与激光工程, 2014, 43(12): 4094-4099.
    [19] 李杰, 朱京平, 齐春, 郑传林, 高博, 张云尧, 侯洵.  大孔径静态超光谱全偏振成像技术 . 红外与激光工程, 2014, 43(2): 574-578.
    [20] 苗锡奎, 朱枫, 郝颖明.  多像机非共视场的非合作飞行器位姿测量方法 . 红外与激光工程, 2013, 42(3): 709-715.
  • 加载中
图(10) / 表(1)
计量
  • 文章访问数:  275
  • HTML全文浏览量:  67
  • PDF下载量:  36
  • 被引次数: 0
出版历程
  • 收稿日期:  2021-04-13
  • 修回日期:  2021-08-23
  • 刊出日期:  2022-04-07

基于最佳偏振角的线性位姿测量方法研究

doi: 10.3788/IRLA20210241
    作者简介:

    王志武,男,硕士生,主要研究方向为基于视觉图像的位姿测量

    通讯作者: 刘斌,男,副教授,博士,主要从事激光及光电测试技术、视觉检测等方面的研究。
基金项目:  国家自然科学基金青年科学基金(51605332,51905378);天津市自然科学基金青年项目(19JCQNJC04200,20JCQNJC00360);天津市技术创新引导专项基金企业科技特派员项目(20YDTPJC00450)
  • 中图分类号: TP391;TH741

摘要: 在基于视觉图像的位姿测量中,非线性位姿测量算法的全局收敛存在不确定性,测量结果取决于初值的选取,不能保证位姿测量的鲁棒性。线性位姿测量算法对图像处理的要求比较高,如果定位特征点图像坐标提取不够精确,会导致位姿测量精度降低。在自然光条件下,相机采集定位特征点图像,图像中高亮度区域的存在对定位特征点提取精度产生影响,进而使有效定位特征点数量减少,影响位姿测量精度。针对上述问题,文中提出了一种基于最佳偏振角的线性位姿测量方法:在相机镜头前加装线偏振片,根据Stokes矢量建立偏振片最佳偏振角度求解模型,在使用最佳偏振角度的前提下采集定位特征点图像,提取图像坐标;建立线性位姿求解模型,计算被测物体位姿。实验结果表明,该方法能够有效减少图像中的高亮度区域,改善成像质量,提高线性位姿测量精度,在−60°~+60°的测量范围内,角度测量误差小于±0.16°,在0~20 mm的测量范围内,位移测量误差小于±0.05 mm。

English Abstract

    • 基于视觉图像的位姿测量[1-3]技术具有结构简单、非接触、测量精度高、稳定性好等优点,因此被广泛应用于工业机器人对准技术[4],机器人手眼标定[5],组合位姿测量[6]等领域。基于视觉图像的位姿测量问题也被称为n点透视投影问题(PnP问题),即在摄像机模型内参数已知的情况下,通过三维空间点的世界坐标和图像坐标求解物体相对摄像机坐标系的位姿信息。

      常用的位姿测量方法主要有非线性算法和线性算法两类。非线性算法在约束条件下建立目标函数,采用最小二乘法、Levenberg-Marquard等方法迭代求解物体位姿。非线性算法求解精度高,正交迭代算法(LHM算法)[7]是非线性算法中的代表性方法,通过最小化物空间共线性误差来构造目标函数,充分利用了透视投影模型的结构特点,保证了算法迭代过程中旋转矩阵的正交性。非线性算法求解时通常需要一个良好的初值才能全局收敛,对初值的选取比较敏感,如果选择不合理,计算时会增加迭代的次数,同时由于迭代产生的结果并不是封闭解,在初值精度较低的情况下会出现局部收敛,全局不收敛的情况,最终将导致不能求解得到精确的位姿信息。

      线性算法计算量较小并且速度快,比非线性算法效率高。线性算法中的代表性方法包括DLS算法[8]、EPnP算法[9]、DLT算法[10]等。但是线性算法也存在一些局限性,对图像处理的要求比较高,如果定位特征点图像坐标提取不够精确,会导致位姿测量精度降低[11]。因此在线性位姿测量时,获取高质量的图像,图像处理后获取足够数量的有效定位特征点非常关键。在自然光条件下,摄像机采集定位特征点图像时,图像中通常存在高亮度区域(高灰度值区域)[12]。这些高亮度区域导致图像的纹理信息丢失,对图像处理产生影响,导致定位特征点图像坐标提取不准确,使参与运算的有效定位特征点数量减少,最终导致线性位姿测量精度降低。研究表明,可以通过在相机镜头前加装偏振片[13-14]并调整偏振片角度,从而减少高亮度区域,改善成像质量,提高视觉图像类测量方法的测量精度[15-16]。Zhu等[17]通过在镜头前添加偏振片,并根据靶标图像灰度值调整适宜的偏振片角度,提高了摄像机标定的精度。

      综上所述,文中提出了一种基于最佳偏振角的线性位姿测量方法。在相机镜头前加装线偏振片,根据Stokes矢量建立偏振片最佳偏振角度求解模型,在最佳偏振角条件下,采集被测物体图像,减少高亮度区域,精确提取定位特征点图像坐标;建立被测物体位姿线性求解模型,计算被测物体位姿;进行了角点提取实验以及测量精度验证实验,实验结果表明,该方法能够有效减少图像中的高亮度区域,使参与位姿求解的有效定位特征点数量增加,提高了线性位姿测量精度,满足现代工业生产中位姿测量的要求。

    • 文中研究在相机镜头前加装线偏振片,并建立最佳偏振角求解模型,在使用最佳偏振角的前提下采集定位特征点图像,减少高亮度区域对图像处理的影响,便于后续进行位姿测量。

      光波具有偏振特性,Stokes矢量可用来表示光的偏振态。Stokes矢量S包含四个Stokes参数:S0, S1, S2, S3,如公式(1)所示,S0表示由成像系统接收的总光强,为x方向和y方向的光强和,S1表示在x方向和y方向的光强差,S2表示+45°方向与-45°方向的光强差,S3表示左旋圆偏振光分量与右旋圆偏振光分量的光强差。Ex, Ey表示光的电矢量Ex方向和y方向的振幅,α表示两者的相位差。

      $$ {\boldsymbol{S}} = \left[ \begin{array}{l} {S_0} \\ {S_1} \\ {S_2} \\ {S_3} \\ \end{array} \right] = \left[ \begin{array}{l} {E_{x}}^2 + {E_y}^2 \\ {E_{x}}^2 - {E_y}^2 \\ 2{E_{x}}{E_y}\cos \alpha \\ 2{E_{x}}{E_y}\sin \alpha \\ \end{array} \right] $$ (1)

      I(0°, 0°), I(45°, 0°)和I(90°, 0°)表示光在0°, 45°和90°三个不同角度的光强,由于光中圆偏振分量非常小,一般可以忽略不计,所以S3=0,Stokes矢量可以进一步表示为公式(2):

      $$ {\boldsymbol{S}}=\left[\begin{array}{l}{S}_{0}\\ {S_1}\\ {S}_{2}\\ {S}_{3}\end{array}\right]=\left[\begin{array}{l}I({0}^{\circ },{0}^{\circ })+I({90}^{\circ },{0}^{\circ })\\ I({0}^{\circ },{0}^{\circ })-I({90}^{\circ },{0}^{\circ })\\ 2I({45}^{\circ },{0}^{\circ })-I({0}^{\circ },{0}^{\circ })-I({90}^{\circ },{0}^{\circ })\\ 0\end{array}\right] $$ (2)

      穆勒矩阵是用来描述偏振片作用的矩阵。使用M表示穆勒矩阵,M11···M44表示穆勒矩阵的16个参数,如公式(3)所示:

      $$ {\boldsymbol{M}} = \left[ {\begin{array}{*{20}{c}} {{M_{11}}}&{{M_{12}}}&{{M_{13}}}&{{M_{14}}}\\ {{M_{21}}}&{{M_{22}}}&{{M_{23}}}&{{M_{24}}}\\ {{M_{31}}}&{{M_{32}}}&{{M_{33}}}&{{M_{34}}}\\ {{M_{41}}}&{{M_{42}}}&{{M_{43}}}&{{M_{44}}} \end{array}} \right]$$ (3)

      图1所示,θ表示偏振片角度,穆勒矩阵M可以表示为公式(4),当偏振片角度发生变化时,穆勒矩阵亦会随之发生变化。

      图  1  偏振片角度示意图

      Figure 1.  Schematic diagram of polarizer angle

      $$ {\boldsymbol{M}} = \frac{1}{2}\left[ {\begin{array}{*{20}{c}} 1&{\cos 2\theta }&{\sin 2\theta }&0\\ 0&{\cos 2\theta }&{\sin 2\theta \cos 2\theta }&0\\ 0&{\sin 2\theta \cos 2\theta }&{{{\sin }^2}2\theta }&0\\ 0&0&0&0 \end{array}} \right]$$ (4)

      Sin表示入射光的Stokes矢量,Sout表示经过偏振片后的出射光的Stokes矢量,由于偏振片的作用,出射光的Stokes矢量和入射光的Stokes矢量之间的关系可以用公式(5)来表示。

      $$ {{\boldsymbol{S}}_{{\text{out}}}} = {\boldsymbol{M}} \cdot {{\boldsymbol{S}}_{{\text{in}}}} $$ (5)

      出射光光强的表达式如公式(6)所示:

      $$ I\left( \theta \right) = \frac{1}{2}{S_0}\left( {x,y} \right) + \frac{1}{2}{S_1}\left( {x,y} \right)\cos 2\theta + \frac{1}{2}{S_2}\left( {x,y} \right)\sin 2\theta $$ (6)

      最终可以得到最佳偏振角度θopt的表达式如公式(7)所示:

      $$ {\theta _{opt}} = \arg {\text{ }}\min \left| {I\left( \theta \right)} \right| $$ (7)
    • 通过摄像机标定得出了摄像机模型内参数,即可以进行物体位姿的求解。如图2所示,Pi是空间的任意点,在图像平面上与之对应的点是pi。空间点在世界坐标系下的坐标是(Xwi, Ywi, Zw),转换到摄像机坐标系下坐标为(Xci, Yci, Zci),旋转矩阵为R3×3,平移向量为T3×1,在图像坐标系下的理想像素坐标为(u, v)。由于文中使用共面定位特征点阵列,所以Zwi=0。由理想图像像素坐标[ui, vi]可以计算出图像坐标[xi, yi]。

      图  2  位姿测量模型

      Figure 2.  Pose measurement model

      已知n组定位特征点的世界坐标[Xwi, Ywi, 0]和相应的图像坐标[xi, yi],构造矩阵A,每行ai为公式(8),共计n行。

      $$ {{\boldsymbol{a}}_{\boldsymbol{i}}} = \left[ {{y_i}} \right.{X_{wi}},{y_i}{Y_{wi}}, - {{\text{x}}_i}{X_{wi}}, - {x_i}{Y_{wi}},\left. {{y_i}} \right] $$ (8)

      μ=[μ1, μ2, μ3, μ4, μ5],旋转参数r11, r12, r21, r22与平移参数tx, ty之比构成μ的各个元素:μ1=r11/ty, μ2=r12/ty, μ3=r21/ty, μ4=r21/ty, μ5=tx/ty

      设向量b=[x1, x2, x3, …, xn]包含了n组定位特征点的图像横坐标xi。因为Ab是已知的,根据公式(9)能解出未知的参数向量μ

      $$ {\boldsymbol{A\mu }} = {\boldsymbol{b}} $$ (9)

      根据μ计算旋转参数和平移参数。设U=μ12+μ22+μ32+μ42,如公式(10)所示计算ty2

      $$ t_y^2 = \frac{{U - {{\left[ {{U^2} - 4{{({\mu _1}{\mu _4} - {\mu _2}{\mu _3})}^2}} \right]}^{\frac{1}{2}}}}}{{2{{({\mu _1}{\mu _4} - {\mu _2}{\mu _3})}^2}}}{\text{ }} $$ (10)

      ty=(ty2)1/2,然后根据μ计算4个旋转参数r11=μ1ty, r12=μ2tyr21=μ3ty, r22=μ4ty和平移参数tx=μ5ty

      为了确定ty的符号,选择一个定位特征点P,其世界坐标为[Xw, Yw, 0],所对应的图像坐标[x, y]远离图像中心,根据公式(11)计算ξxξy。如果ξxx的符号一致且ξyy的符号一致,则ty的符号正确,否则就要改变符号。

      $$\left[ \begin{array}{l} {\xi _x}\\ {\xi _y} \end{array} \right] = \left[ {\begin{array}{*{20}{c}} {{r_{11}}}&{{r_{12}}}&1&0\\ {{r_{21}}}&{{r_{22}}}&0&1 \end{array}} \right]\left[ \begin{array}{l} {x_w}\\ {y_w}\\ {t_x}\\ {t_y} \end{array} \right]$$ (11)

      其余的旋转参数可根据公式(12)进行计算。

      $$ \left\{ \begin{array}{l} {r_{13}} = {\left( {1 - r_{11}^2 - r_{12}^2} \right)^{\frac{1}{2}}} \\ {r_{23}} = {\left( {1 - r_{21}^2 - r_{22}^2} \right)^{\frac{1}{2}}} \\ {r_{31}} = \dfrac{{1 - r_{11}^2 - {r_{12}}{r_{21}}}}{2} \\ {r_{32}} = \dfrac{{1 - {r_{21}}{r_{12}} - r_{22}^2}}{{{r_{23}}}} \\ {r_{33}} = {\left( {1 - {r_{31}}{r_{13}} - {r_{32}}{r_{23}}} \right)^{\frac{1}{2}}} \end{array} \right. $$ (12)

      计算平移参数tz。首先构造矩阵A',矩阵的每一行如公式(13)所示:

      $$ {\boldsymbol{a}}_{\boldsymbol{i}}^{'} = \left( {{r_{21}}{X_{wi}} + {r_{22}}{Y_{wi}} + {t_y},{x_i}} \right) $$ (13)

      构造向量b',每一项如公式(14)所示:

      $$ b_i^{'} = \left( {{r_{31}}{X_{wi}} + {r_{32}}{Y_{wi}}} \right){y_i} $$ (14)

      求解如公式(15)所示的线性方程组,其中v=(f, tz)Tf为焦距,最终得到tz的值。

      $$ {{\boldsymbol{A}}^{'}}{\boldsymbol{v = }}{{\boldsymbol{b}}^{'}} $$ (15)
    • 位姿测量实验系统包括支架,相机,电控旋转平移台、线偏振片和位姿测量靶标,如图3所示。所有实验在密闭室内环境下进行,保持屋内光源位置及光强恒定。

      图  3  位姿测量实验系统

      Figure 3.  Experimental system of pose measurement

      实验中使用棋盘靶标,棋盘格尺寸为25 mm×25 mm。实验中的图像采集设备为海康威视MV-CA016-10UM相机,分辨率为1440×1080,像元尺寸为3.45 μm×3.45 μm,相机标定结果如表1所示。

      文中的实验包括两部分:角点提取实验和测量精度验证实验。

      表 1  相机标定实验结果

      Table 1.  Camera calibration experiment results

      Focal lengthfx =3425.60506fy =3426.03573
      Principal pointCx =732.2264Cy =496.46005
      Radial distortionk1=−0.0855k2 =0.8394k3 =−9.7639
      Tangential distortionp1 =0.00023224p2 =0.00023113
    • 将靶标置于相机镜头前,近似平行于相机成像面,分别在偏振角0°、偏振角45°、偏振角90°的条件下,采集靶标图像,根据公式(7)完成最佳偏振角求解。在自然光(不加偏振片)条件下和最佳偏振角条件下分别采集靶标图像,共计2幅图像,使用相同的角点提取算法,提取出来11×8的角点阵列,角点分布如图4(a)和(b)所示,两幅图像对应的角点在x方向和y方向上的像素坐标差值分布如图4(c)所示,x方向上的像素坐标差值在[−3.751,−0.893]范围内,y方向上的像素坐标差值在[−4.068,0.052]范围内。可以看出,在最佳偏振角条件下采集的棋盘图像提取的角点坐标与自然光条件下采集的棋盘图像提取的角点坐标相差约2个像素,证明了在最佳偏振角条件下的图像角点坐标不同于自然光条件下的图像角点坐标。

      图  4  角点提取实验结果

      Figure 4.  Experimental results of corner points extraction

      实验中使用的棋盘靶标由彼此平行的11条水平线组成,当靶标平面近似平行于相机成像面时,由棋盘格图像的角点所拟合的11条水平线也应该是近似平行的,斜率近似相等。如图4(d)所示,黑线表示自然光条件下角点像素坐标拟合的11条水平线斜率的变化趋势,红线表示最佳偏振角条件下角点像素坐标拟合的11条水平线斜率的变化趋势,斜率的标准差分别为0.00984和0.0072。自然光条件下角点像素坐标拟合直线的斜率变化要比最佳偏振角条件下拟合直线的斜率变化更为明显,因此最佳偏振角条件下采集的图像进行角点提取具有更好的精度,证明了文中基于偏振信息采集图像提取角点的可行性和优越性。

    • 将摄像机固定到支架上,偏振片固定于镜头前,针对任意一个测量位置,在0°,45°和90°三个不同偏振角度条件下采集靶标图像,根据公式(7)完成最佳偏振角求解,调整偏振片角度至最佳偏振角,采集图像,提取定位特征点(角点),计算靶标位姿。位姿测量精度验证实验包括旋转角度测量实验和位移测量实验。

    • 将靶标0°位置记为初始位置。设定靶标顺时针旋转为正,以5°为间隔进行旋转,直至+60°;设定靶标逆时针旋转为负,以5°为间隔进行旋转,直至−60°。靶标各旋转位置在最佳偏振角条件下采集图像,得到的靶标图像以及每个旋转位置对应的最佳偏振角度如图5所示,po表示靶标的旋转位置,op表示计算得出的偏振片在当前旋转位置对应的最佳偏振角。

      图  5  各位置在最佳偏振角条件下采集的图像

      Figure 5.  Images collected at each position on the condition of optimal polarization angle

      在自然光(不加偏振片),偏振角0°,45°,90°以及最佳偏振角条件下,采集靶标图像,使用文中提出的线性算法计算各位置靶标位姿并计算定位特征点平均重投影误差,实验结果如图6所示,在自然光(不加偏振片)条件下计算得出的定位特征点平均重投影误差更高,在最佳偏振角条件下采集图像,能够有效降低高亮度区域对图像处理的影响,从而提升位姿测量精度,降低靶标位姿测量的平均重投影误差,充分证明了文中方法的优势。

      图  6  旋转测量实验的平均重投影误差

      Figure 6.  Mean reprojection errors of rotation measurement experiments

      在自然光(不加偏振片)与最佳偏振角条件下,使用文中提出的线性算法计算各旋转位置的靶标位姿,得到所有定位特征点x方向与y方向的重投影误差,误差分布图如图7所示。图7(a)为自然光条件下对应的误差分布图,图7(b)为最佳偏振角条件下对应的误差分布图。自然光条件下所有定位特征点在x方向的重投影误差均值为−0.145 pixel,y方向的重投影误差均值为0.125 pixel。最佳偏振角条件下所有定位特征点在x方向的重投影误差均值为−0.05781 pixel,y方向的重投影误差均值为0.0675 pixel,x方向和y方向分别降低了0.09 pixel和0.06 pixel。

      图  7  自然光与最佳偏振角条件下的误差分布图

      Figure 7.  Error distribution of natural light and optimal polarization angle

      当靶标旋转角度较大(+40°~+60°和−40°~−60°)时,高亮度区域更为明显,对定位特征点图像坐标提取影响增大,最佳偏振角的效果更为明显,x方向的平均重投影误差降低范围为[0.0203, 0.2184] pixel,y方向的平均重投影误差降低范围为[0.0349, 0.1731] pixel。

      在线性算法(不加偏振片),LHM算法(不加偏振片),线性算法(最佳偏振角)三种条件下分别计算靶标位姿,并计算靶标当前位置相对初始位置(0°)的夹角,测量结果如图8所示,正交迭代算法(LHM)是非线性算法的代表性方法,在自然光(不加偏振片)条件下,其精度优于线性算法。但是在最佳偏振角条件下采集图像,能够有效降低高亮度区域对图像处理的影响,使参与运算的有效定位特征点数量增加,线性算法的精度得到提升,精度优于非线性算法(LHM),测量误差小于±0.16°,测量标准差为0.068°。

      图  8  角度测量实验结果

      Figure 8.  Experimental results of angle measurement

    • 将靶标固定在平移台基准位置(0 mm)处,靶标每次平移距离为0.5 mm,从0 mm移动到20 mm处共41个位置。在自然光(不加偏振片)和最佳偏振角条件下,使用文中提出的线性算法计算各位置靶标位姿并计算定位特征点平均重投影误差,实验结果如图9所示,在最佳偏振角条件下采集图像,能够有效降低高亮度区域对图像处理的影响,从而提升位姿测量精度,降低靶标位姿测量的平均重投影误差。

      图  9  位移测量实验的平均重投影误差

      Figure 9.  Mean reprojection errors of translation measurement experiments

      在线性算法(不加偏振片),LHM算法(不加偏振片),线性算法(最佳偏振角)三种条件下分别计算靶标位姿,并计算靶标当前位置相对初始位置(0 mm)的距离,测量结果如图10所示。LHM算法在自然光(不加偏振片)条件下,其精度优于线性算法。但是在最佳偏振角条件下采集图像,能够有效降低高亮度区域对图像处理的影响,使参与运算的有效定位特征点数量增加,线性算法的精度得到提升,精度优于非线性算法(LHM),测量误差小于±0.05 mm,测量标准差为0.034 mm。

      综上,在旋转角度测量实验中,最佳偏振角条件下的测量相比于自然光条件下的测量,平均重投影误差降低了0.101 pixel。在最佳偏振角条件下使用线性算法测量靶标位姿,角度测量误差小于±0.16°,测量标准差为0.068°。在位移测量实验中,在最佳偏振角条件下的测量相比于自然光条件下的测量,平均重投影误差降低了0.046 pixel。在最佳偏振角条件下使用线性算法测量靶标位姿,位移测量误差小于±0.05 mm,测量标准差为0.034 mm。

      图  10  位移测量实验结果

      Figure 10.  Experiment results of displacement measurement errors

    • 文中在相机镜头前加装线偏振片,提出基于最佳偏振角的线性位姿测量方法。根据Stokes矢量建立最佳偏振角度求解模型,在使用最佳偏振角度的前提下采集定位特征点图像,提取定位特征点图像坐标;建立线性位姿求解模型,求解被测物体位姿。进行了角点提取实验和测量精度验证实验,实验结果表明,在最佳偏振角条件下采集被测物体图像,能够减少高亮度区域,精确提取定位特征点图像坐标,使参与位姿求解的有效定位特征点数量增加,提高了线性位姿测量方法的精度。在−60°~+60°的测量范围内,角度测量误差小于±0.16°,测量标准差为0.068°。在0~20 mm的测量范围内,位移测量误差小于±0.05 mm,测量标准差为0.034 mm。文中提出的测量方法为位姿测量提供了一种新的可行的手段。该方法可应用于工业机器人对准技术,机器人手眼标定,组合位姿测量等领域。

参考文献 (17)

目录

    /

    返回文章
    返回