留言板

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

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

激光跟踪干涉系统基点的直线约束标定方法

晁祥璋 刁晓飞 康岩辉 范芯蕊 雷李华 刘丽琴

晁祥璋, 刁晓飞, 康岩辉, 范芯蕊, 雷李华, 刘丽琴. 激光跟踪干涉系统基点的直线约束标定方法[J]. 红外与激光工程, 2023, 52(12): 20230288. doi: 10.3788/IRLA20230288
引用本文: 晁祥璋, 刁晓飞, 康岩辉, 范芯蕊, 雷李华, 刘丽琴. 激光跟踪干涉系统基点的直线约束标定方法[J]. 红外与激光工程, 2023, 52(12): 20230288. doi: 10.3788/IRLA20230288
Chao Xiangzhang, Diao Xiaofei, Kang Yanhui, Fan Xinrui, Lei Lihua, Liu Liqin. Linear constraint approach for calibrating distance of base point in laser tracking interferometer system[J]. Infrared and Laser Engineering, 2023, 52(12): 20230288. doi: 10.3788/IRLA20230288
Citation: Chao Xiangzhang, Diao Xiaofei, Kang Yanhui, Fan Xinrui, Lei Lihua, Liu Liqin. Linear constraint approach for calibrating distance of base point in laser tracking interferometer system[J]. Infrared and Laser Engineering, 2023, 52(12): 20230288. doi: 10.3788/IRLA20230288

激光跟踪干涉系统基点的直线约束标定方法

doi: 10.3788/IRLA20230288
基金项目: 中国计量科学研究院基本科研业务费重点领域项目(AKYZD2109);上海市自然科学基金项目(21ZR1483100);上海市优秀学术/技术带头人计划项目(21XD1425000)
详细信息
    作者简介:

    晁祥璋,男,硕士生,主要从事精密测量技术方面的研究

  • 中图分类号: TH741

Linear constraint approach for calibrating distance of base point in laser tracking interferometer system

Funds: Basic Research Foundation of National Institute of Metrology (AKYZD2109); Natural Science Foundation of Shanghai (21ZR1483100); Program of Shanghai Academic/Technology Research Leader (21XD1425000)
  • 摘要: 激光跟踪干涉系统的测量精度是工业机器人标定精度的主要影响因素,其基点标定精度决定了激光跟踪干涉系统的测量精度。为了确定基点与激光跟踪干涉系统的准确距离,提出了一种激光跟踪干涉系统基点的直线约束标定方法。建立了基于直线约束的数学标定模型,使各标定约束点分布在同一直线上,可直接应用干涉测量方法获取约束点的精确坐标,使用最小二乘法进行数值解析确定基点距离,该方法具有原理简单、误差源少、测量精度高的特性。针对影响标定精度的各项参数进行了数值仿真分析,优化标定参数,减小标定误差;最终搭建了实验装置评估该标定方法的性能,实验结果表明,激光跟踪干涉系统的基点距离平均值为290.076 4 mm,标准差为4.4 μm,满足对工业机器人标定的精度需求;为验证该方法的准确性,对API radian激光跟踪仪的基点距离进行比对测试,与其标称值相差3 μm。
  • 图  1  机器人标定的测量方案

    Figure  1.  Measurement scheme of robot calibration

    图  2  基于直线约束的基点距离标定原理

    Figure  2.  DBP calibration method based on linear constraint

    图  3  L/d不同比值情况下的标定误差

    Figure  3.  Calibration error in different values of L/d

    图  4  LTIS位置对标定误差的影响

    Figure  4.  Influence of LTIS position on calibration error

    图  5  基点距离标定实验系统

    Figure  5.  Experimental system of DBP calibration

    图  6  (a) 空气折射率补偿装置;(b) 标定验证实验系统;(c) API跟踪仪

    Figure  6.  (a) Air refractive index compensation; (b) The verification experimental system of calibration; (c) API tracker

    表  1  仿真环境与参数设置

    Table  1.   Simulation environment and parameters set

    ItemsParameter
    EnvironmentIntel i5 7th Gen
    Distance of base point (DBP)350 mm
    Error of interferometerX-N (0, 0.5 μm)
    Error of LTISX-N (0, 0.5 μm)
    下载: 导出CSV

    表  2  对激光跟踪干涉系统的基点距离标定结果

    Table  2.   DBP calibration result for LTIS

    No.DBP/mmAverage x0/mmAverage l0/mm
    1290.06881492.0213290.0764
    2290.0857
    3290.0748
    4290.0652
    5290.0877
    下载: 导出CSV

    表  3  基点距离的加权平均值与平均值的标准差

    Table  3.   Weight average and its standard deviation of DBP

    12345
    $ \sigma_{\|} $0.05020.11280.05110.05590.0473
    $ p_{i} $397.578.666382.44319.62446.27
    $ \bar{l}_{0} $29.0764 mm
    $ \sigma_{T_{1}} $4.4 μm
    下载: 导出CSV

    表  4  API radian跟踪仪基点距离标定结果

    Table  4.   DBP calibration results for API radian

    No. DBP/mmWeighted average
    /mm
    API value/mmError
    /mm
    1154.2002154.1940154.19100.003
    2154.1892
    3154.1993
    4154.1868
    5154.1968
    下载: 导出CSV
  • [1] 赵海鹏, 杜玉红, 丁娟, 等. 移动机器人中激光雷达测距测角标定方法[J]. 红外与激光工程, 2019, 48(06): 371-378. doi:  doi:10.3788/IRLA201948.06300020002

    Zhao Haipeng, Du Yuhong, Ding Juan, et al. LiDAR ranging angle measurement calibration method in mobile robot [J]. Infrared and Laser Engineering, 2019, 48(6): 0630002. (in Chinese) doi:  doi:10.3788/IRLA201948.06300020002
    [2] 乔贵方, 孙大林, 温秀兰, 等. 面向机器人标定的单激光跟踪仪顺序多站式测量系统建模与分析[J]. 计量学报, 2020, 41(11): 1313-1320.

    Qiao Guifang, Sun Dalin, Wen Xiulan, et al. Modeling and analysis of sequential multi-lateration measurement system based on single laser tracker for robot calibration [J]. Acta Metrologica Sinica, 2020, 41(11): 1313-1320. (in Chinese)
    [3] Li X, Zhang E, Fang X, et al. Calibration method for industrial robots based on the principle of perigon error close [J]. IEEE Access, 2022, 10: 48569-48576. doi:  10.1109/ACCESS.2022.3172505
    [4] Miao L, Zhang Y, Song Z, et al. A two-step method for kinematic parameters calibration based on complete pose measurement-verification on a heavy-duty robot [J]. Robotics and Computer-Integrated Manufacturing, 2023, 83: 102550. doi:  https://doi.org/10.1016/j.rcim.2023.102550
    [5] 杜 亮, 张 铁, 戴孝亮, 等. 激光跟踪仪测量距离误差的机器人运动学参数补偿[J]. 红外与激光工程, 2015, 44(8): 2352-2357.

    Du Liang, Zhang Tie, Dai Xiaoliang, et al. Robot kinematic parameters compensation by measuring distance error using laser tracker system [J]. Infrared and Laser Engineering, 2015, 44(8): 2352-2357. (in Chinese)
    [6] 陈相君, 古力那尔·祖农, 薛梓, 等. 基于激光跟踪仪的协作机器人标定算法与实验研究[J]. 计量学报, 2021, 42(5): 552-557.

    Chen Xiangjun, Gulinaer Zunong, Xue Zi, et al. Calibration algorithm and experimental research of cooperative robot based on laser tracker [J]. Acta Metrologica Sinica, 2021, 42(5): 552-557. (in Chinese)
    [7] 邢运隆, 李论. 一种基于指数积的机械臂结构参数标定方法[J]. 制造业自动化, 2023, 45(02): 12-16+29.

    Xing Yunlong, Li Lun. A calibration method of mechanical arm structure parameters based on exponential product [J]. Manufacturing Automation, 2023, 45(2): 12-16, 29. (in Chinese)
    [8] 何俊, 张福民, 张画迪, 等. 基于球心拟合的多边激光跟踪系统自标定方法[J]. 红外与激光工程, 2020, 49(8): 201904381-201904387.

    He Jun, Zhang Fumin, Zhang Huadi, et al. Multilateral laser tracking system self-calibration method based on spherical center fitting [J]. Infrared and Laser Engineering, 2020, 49(8): 201904381. (in Chinese)
    [9] 刘健, 刘巍伟, 臧延旭. 基于激光测量技术的远距离目标高精度跟踪研究[J]. 激光杂志, 2021, 42(11): 60-64.

    Liu Jian, Liu Weiwei, Zang Yanxu. High precision tracking of long-distance target based laser measurement technology [J]. Laser Journal, 2021, 42(11): 60-64. (in Chinese)
    [10] 平少栋, 傅云霞, 张丰, 等. 镜面反射式激光跟踪干涉测长的测量方法研究[J]. 红外与激光工程. 2021, 50(12): 403-409. doi:  10.3788/IRLA20210624

    Ping Shaodong, Fu Yunxia, Zhang Feng, et al. Study on measurement method of mirror reflection laser tracking interferometric length measurement [J]. Infrared and Laser Engineering, 2021, 50(12): 20210624. (in Chinese) doi:  10.3788/IRLA20210624
    [11] Zhuang H, Motaghedi S H, Roth Z, et al. Calibration of multi-beam laser tracking systems [J]. Robotics and Computer Integrated Manufacturing, 2003, 19(4): 301-314. doi:  10.1016/S0736-5845(02)00076-5
    [12] Motaghedi S H. Self-calibration of laser tracking measurement system with planar constraints[D] Florida: College of Engineering, Florida Atlantic University, 1999.
    [13] 张亚娟. 单站式激光跟踪坐标测量系统研究[D]. 天津: 天津大学, 2012.

    Zhang Yajuan. Stand alone laser tracking system[D]. Tianjin: Tianjin University, 2012. (in Chinese)
    [14] Zhang Yajuan, Qiu Zurong, Li Xinghua, et al. Calibration of laser tracking system with spherical constraint [J]. Journal of Tianjin University (Science and Technology), 2014, 47(3): 255-261. (in Chinese)
    [15] 李杏华. 激光跟踪系统的设计[D]. 天津: 天津大学, 2003.

    Li Xinghua. Design of a laser tracking system[D]. Tianjin: Tianjin University, 2003. (in Chinese)
    [16] 周春艳. 激光跟踪坐标测量系统的双线法基点自标定[J]. 科学技术与工程, 2009, 9(12): 3429-3431.

    Zhou Chunyan. Double line of base point self calibration in laser tracking coordinate measuring system [J]. Science Technology and Engineering, 2009, 9(12): 3429-3431. (in Chinese)
    [17] 许航, 熊芝, 张刘港, 等. 基于加权最小二乘的激光跟踪姿态角测量方法[J]. 红外与激光工程, 2022, 51(6): 20210675. doi:  10.3788/IRLA20210675

    Xu Hang, Xiong Zhi, Zhang Liugang, et al. Laser tracking attitude angle measurement method based on weighted least squares [J]. Infrared and Laser Engineering, 2022, 51(6): 20210675. (in Chinese) doi:  10.3788/IRLA20210675
  • [1] 兰猗令, 康传利, 王宁, 杨佳乐, 陈进启.  附加增值条件的移动最小二乘法的点云孔洞修补 . 红外与激光工程, 2023, 52(2): 20220390-1-20220390-10. doi: 10.3788/IRLA20220390
    [2] 刘云哲, 董岩, 王伟, 宋建林.  光电跟踪系统的摩擦模型辨识与补偿策略研究 . 红外与激光工程, 2023, 52(11): 20230151-1-20230151-9. doi: 10.3788/IRLA20230151
    [3] 黄喆, 燕庆德, 李倩, 程二静, 沈小玲, 徐叶倩.  面向直线顶管机的双屏视觉标靶标定方法与精度评价 . 红外与激光工程, 2022, 51(9): 20210933-1-20210933-8. doi: 10.3788/IRLA20210933
    [4] 许航, 熊芝, 张刘港, 冯维, 翟中生, 周维虎, 董登峰.  基于加权最小二乘的激光跟踪姿态角测量方法 . 红外与激光工程, 2022, 51(6): 20210675-1-20210675-6. doi: 10.3788/IRLA20210675
    [5] Ma Jinyu, Chen Xin, Ding Guoqing, Chen Jigang.  Research on angle setting error of diameter measurement based on laser displacement sensors . 红外与激光工程, 2021, 50(5): 20200316-1-20200316-7. doi: 10.3788/IRLA20200316
    [6] 许艺腾, 李国元, 邱春霞, 薛玉彩.  基于地形相关和最小二乘曲线拟合的单光子激光数据处理技术 . 红外与激光工程, 2019, 48(12): 1205004-1205004(10). doi: 10.3788/IRLA201948.1205004
    [7] 赵丽娟, 徐志钮, 李永倩.  布里渊增益谱特征参数提取准确性影响因素分析 . 红外与激光工程, 2019, 48(2): 222003-0222003(8). doi: 10.3788/IRLA201948.0222003
    [8] 兰斌, 吴小霞, 杨洪波, 蒋权, 张正铎.  广义最小二乘法在主动光学模式定标中的应用 . 红外与激光工程, 2017, 46(6): 617001-0617001(7). doi: 10.3788/IRLA201746.0617001
    [9] 金星, 常浩, 叶继飞.  超短脉冲激光烧蚀冲量耦合测量方法 . 红外与激光工程, 2017, 46(3): 329002-0329002(7). doi: 10.3788/IRLA201746.0329002
    [10] 李双, 袁齐, 龚平.  空间调制偏振光谱测量定标方法 . 红外与激光工程, 2016, 45(11): 1113002-1113002(5). doi: 10.3788/IRLA201645.1113002
    [11] 肖志涛, 朱莎莎, 耿磊, 李月龙, 刘文超, 叶琨.  深度约束的零件尺寸测量系统标定方法 . 红外与激光工程, 2015, 44(9): 2831-2836.
    [12] 何其锐, 李立萍.  减小声光频谱仪频率测量方差算法研究 . 红外与激光工程, 2015, 44(5): 1564-1568.
    [13] 刘常杰, 刘洪伟, 郭寅, 刘邈, 张宾, 叶声华.  基于扫描激光雷达的列车速度测量系统 . 红外与激光工程, 2015, 44(1): 285-290.
    [14] 王拯洲, 胡炳樑, 殷勤业, 曹世康, 李东坚, 李红光.  综合诊断系统多维度重构小孔光斑中心测量方法 . 红外与激光工程, 2015, 44(S1): 73-79.
    [15] 张周锋, 谢永军, 胡炳樑, 殷勤业, 于涛.  大孔径静态干涉成像光谱仪探测器配准误差标定方法 . 红外与激光工程, 2015, 44(5): 1643-1646.
    [16] 张磊, 何昕, 魏仲慧, 梁国龙.  星图分布对星敏感器最小二乘姿态精度的影响 . 红外与激光工程, 2014, 43(6): 1836-1841.
    [17] 梁栋, 谢巧云, 黄文江, 彭代亮, 杨晓华, 黄林生, 胡勇.  最小二乘支持向量机用于时间序列叶面积指数预测 . 红外与激光工程, 2014, 43(1): 243-248.
    [18] 蔺辉, 刘立力, 田新锋, 郝芸.  强激光近场分布测量中科学级CCD 的非均匀性校正 . 红外与激光工程, 2014, 43(7): 2108-2111.
    [19] 曹世康, 李东坚, 许瑞华, 王伟, 王拯洲.  基于最优弧的激光光斑中心检测算法 . 红外与激光工程, 2014, 43(10): 3492-3496.
    [20] 王子辰, 戴明, 李刚, 汪永阳, 宋悦铭, 高玉军.  基于虚拟立体靶标的线阵相机标定与分析 . 红外与激光工程, 2014, 43(3): 902-907.
  • 加载中
图(6) / 表(4)
计量
  • 文章访问数:  57
  • HTML全文浏览量:  23
  • PDF下载量:  21
  • 被引次数: 0
出版历程
  • 收稿日期:  2023-05-07
  • 修回日期:  2023-06-20
  • 录用日期:  2023-07-03
  • 网络出版日期:  2023-12-22
  • 刊出日期:  2023-12-22

激光跟踪干涉系统基点的直线约束标定方法

doi: 10.3788/IRLA20230288
    作者简介:

    晁祥璋,男,硕士生,主要从事精密测量技术方面的研究

基金项目:  中国计量科学研究院基本科研业务费重点领域项目(AKYZD2109);上海市自然科学基金项目(21ZR1483100);上海市优秀学术/技术带头人计划项目(21XD1425000)
  • 中图分类号: TH741

摘要: 激光跟踪干涉系统的测量精度是工业机器人标定精度的主要影响因素,其基点标定精度决定了激光跟踪干涉系统的测量精度。为了确定基点与激光跟踪干涉系统的准确距离,提出了一种激光跟踪干涉系统基点的直线约束标定方法。建立了基于直线约束的数学标定模型,使各标定约束点分布在同一直线上,可直接应用干涉测量方法获取约束点的精确坐标,使用最小二乘法进行数值解析确定基点距离,该方法具有原理简单、误差源少、测量精度高的特性。针对影响标定精度的各项参数进行了数值仿真分析,优化标定参数,减小标定误差;最终搭建了实验装置评估该标定方法的性能,实验结果表明,激光跟踪干涉系统的基点距离平均值为290.076 4 mm,标准差为4.4 μm,满足对工业机器人标定的精度需求;为验证该方法的准确性,对API radian激光跟踪仪的基点距离进行比对测试,与其标称值相差3 μm。

English Abstract

    • 工业机器人在现代社会中的应用越来越广泛,在汽车制造、航空航天、医疗卫生等领域都有着举足轻重的地位[1-4];医用机器人的绝对定位精度在亚毫米级别,某些场合中装配机器人的绝对定位精度要达到0.01 mm以下,然而由于工业机器人在生产制造过程中存在加工误差及装配误差,在未经标定的情况下其绝对定位精度一般在0.5~10 mm。因此需要对机器人的DH参数进行标定,使其能够达到与其任务相匹配的精度水平。

      在基于距离误差模型的工业机器人DH参数标定工作中,需要获取机器人末端到测量设备的绝对距离。现阶段,往往使用激光跟踪仪进行测量工作[5-7],然而激光跟踪仪作为通用测量设备,其功能齐全、操作复杂、价格昂贵,因此亟需一种低成本、操作简单的高精度机器人标定专用设备。目前,国内外学者主要使用激光干涉跟踪测量技术[8-10]进行高精度测量,采用干涉测量技术对机器人的DH参数误差进行标定。在测量过程中需要一个基点来实现绝对距离测量,基点与干涉测量设备的距离称为基点距离。

      为了准确地测量出基点距离,美国佛罗里达大西洋大学的Motaghedi S H设计了约束平面法来求解基点坐标[11-12],但是难以获得高精度的约束平面制约了平面约束方法的标定精度;天津大学的张亚娟提出了基于球面约束的基点标定方法 [13-14],球面约束利用三坐标机和球杆仪作为测量工具,系统复杂不具有灵活性;天津大学的李杏华[15]提出了基于直线约束的标定方法,该方法利用余弦定理构建约束关系对基点距离进行标定,约束直线需要过基点,受到基点的制约;北方民族大学的周春燕[16]提出了基于双线法的基点标定方法,这种方法需要安装两条严格正交的导轨,这在操作上有一定的难度。

      为了实现对激光跟踪干涉系统(LTIS)基点距离的准确标定,解决现有基点标定约束关系复杂、对约束要求精度高、引入误差源多等问题,文中提出了一种激光跟踪干涉系统基点的直线约束标定方法,约束直线无需过基点,利用点与点之间的距离关系构建约束方程,可以直接解算激光跟踪干涉系统的基点距离;经分析发现,该方法的参数设置会影响标定精度,文中对各项参数进行了数值仿真分析,以减小标定误差。该方法在标定过程中只使用了激光干涉测量的位移信息,具有标定方法简单、引入误源差少、测量精度高的特点。对基点距离进行标定后的激光跟踪干涉系统可以进行机器人DH参数误差的标定工作。

    • 在基于距离误差模型的工业机器人DH参数标定工作中,工业机器人末端测量方案如图1所示, A为激光跟踪干涉系统的位置,B为工业机器人末端执行器的位置,C为基点靶座,l0为基点距离(Distance of base point, DBP)。激光跟踪干涉系统只有干涉测量模块和跟踪模块,仅能测量出机器人末端B相对于基点C的距离变化量Δl。若已知基点距离l0,就可以确定机器人末端B与激光跟踪干涉系统位置A的绝对距离。在该系统中,基点距离l0是影响绝对测距精度的主要因素之一,并且不需要求解激光跟踪干涉系统位置A的坐标,只需计算l0的长度。

      与文献[15]相比,文中方法主要有以下两点不同:1) 约束关系的构建方式方面,该方法通过三角形利用余弦定理构建约束方程,文中利用两点之间的距离关系构建约束方程;2) 约束直线方面,该方法选取的约束直线需要通过测量初始点,即文中的基点,对约束直线形成制约,文中提出的方法约束直线不需要通过基点,对约束直线选取没有限制。

      图  1  机器人标定的测量方案

      Figure 1.  Measurement scheme of robot calibration

      激光跟踪干涉系统基点的直线约束标定方法原理如图2所示,约束直线长度为L,激光跟踪干涉系统与约束直线的距离为dP0为激光跟踪干涉系统的位置,B为基点,Pi为第i个约束点,lii个约束点Pi相对于基点的距离变化,l0为基点距离。以约束直线作为x轴,激光干涉仪的测量初始点P1为原点建立坐标系。约束点Pi(xi, yi, zi)均匀分布在x轴上。根据几何关系可得约束方程:

      $$ \left|\boldsymbol{P}_{t}-\boldsymbol{P}_{0}\right|=l_{0}+l_{t} $$ (1)

      i个点和第i+1个点的约束方程为:

      $$ \left\{\begin{array}{l} x_{i}^{2}-2 x_{i} x_{0}+x_{0}^{2}+ \\ y_{i}^{2}-2 y_{i} y_{0}+y_{0}^{2} +\\ z_{i}^{2}-2 z_{i} z_{0}+z_{0}^{2}=\left(l_{0}+l_{i}\right)^{2} \\ x_{i+1}^{2}-2 x_{i+1} x_{0}+x_{0}^{2}+ \\ y_{i+1}^{2}-2 y_{i+1} y_{0}+y_{0}^{2}+ \\ z_{i+1}^{2}-2 z_{l+1} z_{0}+z_{0}^{2}=\left(l_{0}+I_{i+l}\right)^{2} \end{array}\right. $$ (2)

      式中:xi为第i个约束点的x坐标;yi为第i个约束点的y坐标;zi为第i个约束点的z坐标;l0为基点距离;li为第i个约束点与基点的距离变化。

      图  2  基于直线约束的基点距离标定原理

      Figure 2.  DBP calibration method based on linear constraint

      将公式(2)中的两式相减,可得:

      $$ \begin{split} & 2\left(x_{i+1}-x_{i}\right) x_{0}+2\left(y_{i+1}-y_{i}\right) y_{0}+ \\ & 2\left(z_{l+1}-z_{i}\right) z_{0}+2\left(l_{i+1}-l_{i}\right) l_{0} =\\ & \left(x_{i+1}^{2}+y_{i+1}^{2}+z_{i+1}^{2}\right) -\\ & \left(x_{i}^{2}+y_{i}^{2}+z_{l}^{2}\right)+\left(l_{i}^{2}-l_{i+1}^{2}\right) \end{split} $$ (3)

      非线性约束方程(1)转化为线性约束方程(3)。约束点都在x轴上,所以方程(3)可以简化为:

      $$ \begin{split} & 2\left(x_{i+1}-x_{i}\right) x_{0}+2\left(l_{i+1}-l_{i}\right) I_{0} =\\ & x_{i+1}^{2}-x_{i}^{2}+\left(l_{i+1}^{2}-l_{i}^{2}\right) \end{split} $$ (4)

      根据最小二乘法的基本原理[17]解出基点距离l0和激光跟踪干涉系统的横坐标x0

      设约束点数量为N,公式(4)可以写成矩阵形式:

      $$ \boldsymbol{A X}=\boldsymbol{B} $$ (5)

      其中,

      $$ \begin{array}{l} \boldsymbol{X}=\left(\begin{array}{l} x_{0} \\ l_{0} \end{array}\right) \\ \boldsymbol{A}=2\left(\begin{array}{cc} x_{2}-x_{1} & l_{2}-l_{1} \\ x_{3}-x_{2} & l_{3}-l_{2} \\ \vdots & \vdots \\ x_{N}-x_{N-1} & l_{N}-l_{N-1} \end{array}\right) \\ \boldsymbol{B}=\left(\begin{array}{c} x_{2}^{2}-x_{1}^{2}+l_{2}^{2}-l_{1}^{2} \\ x_{3}^{2}-x_{2}^{2}+l_{3}^{2}-l_{2}^{2} \\ \vdots \\ x_{N+1}^{2}-x_{N}^{2}+l_{N+1}^{2}-l_{N}^{2} \end{array}\right) \end{array} $$
    • 根据公式(5)可知相邻约束点之间的间距过小或者当激光干涉仪测得相邻两约束点的li差别不大时,系数矩阵A的第二列是一个微小变化量,使得最小二乘法的系数矩阵变为如下形式:

      $$ {\boldsymbol{A}}=2\left(\begin{array}{cc} x_{2}-x_{1} & \delta_{12} \\ x_{3}-x_{2} & \delta_{22} \\ \vdots & \vdots \\ x_{n}-x_{n-1} & \delta_{m 2} \end{array}\right) $$ (6)

      式中:δij是一个微小量。公式(5)可写为:

      $$ \boldsymbol{A}^{\rm{T}} \boldsymbol{A X}=\boldsymbol{A}^{\rm{T}} \boldsymbol{B} $$ (7)

      所以,

      $$ \boldsymbol{X}=\left(\boldsymbol{A}^{\mathrm{T}} \boldsymbol{A}\right)^{-1} \boldsymbol{A}^{\mathrm{T}} \boldsymbol{B} $$ (8)

      其中,ATA的表达式为:

      $$ \boldsymbol{A}^{\rm{T}} \boldsymbol{A}=4\left(\begin{array}{cc} a & \Delta_{12} \\ \Delta_{21} & \Delta_{22} \end{array}\right) $$ (9)

      其中,

      $$ \begin{aligned} a & =\left(x_{i+1}-x_{i}\right)^{2} \\ \Delta_{12} & =\Delta_{21}=\sum\left(x_{i+1}-x_{i}\right) \delta_{i 2} \\ \Delta_{22} & =\sum \delta_{i 2}^{2} \end{aligned} $$

      相邻两约束点之间距离越近,相邻两约束点之间的lili+1差别越小,公式(9)表明ATA矩阵条件数就越大,使得基点距离的标定误差变大。因此在使用基点的直线约束标定模型时,约束点需要在约束直线上分散开,使相邻约束点之间的li有显著的变化。

      在对基点的标定过程中,约束直线长度为L、激光跟踪干涉系统与约束直线的距离为dLd的比值、约束点个数N、激光跟踪干涉系统位置P0均会影响标定精度,因此需要分别研究这些参数对标定结果的影响,使用计算机仿真软件对各影响参数进行仿真实验,根据仿真结果选择合适的参数,仿真环境与参数如表1所示。

      表 1  仿真环境与参数设置

      Table 1.  Simulation environment and parameters set

      ItemsParameter
      EnvironmentIntel i5 7th Gen
      Distance of base point (DBP)350 mm
      Error of interferometerX-N (0, 0.5 μm)
      Error of LTISX-N (0, 0.5 μm)

      1) L/d对标定精度的影响

      为了探究Ld之间的比值对标定精度的影响,仿真参数按照表1设置,选取约束点数量N=20,令L/d的值从0.5~4之间变化,计算标定误差。标定误差的计算方法如公式(10)所示:

      $$ e=\left|D_{\text {cali }}-D_{\text {real }}\right| $$ (10)

      式中:e为标定误差;Dcali为标定后的基点距离;Dreal为仿真中基点距离的真值。

      标定误差与L/d的关系如图3所示,当0.5≤L/d≤2时,标定误差随着比值的增大从0.035 mm降至0.0025 mm,当L/d > 2时标定误差减小缓慢,继续增大L/d对减小标定误差的意义不大。所以结Ld的比值应控制在1.5~2之间,这里选择L/d = 2。

      图  3  L/d不同比值情况下的标定误差

      Figure 3.  Calibration error in different values of L/d

      2)约束点数量N对标定精度的影响

      为了分析约束点数量N对基点标定精度的影响,根据1)中的仿真结果,确定约束直线长度L=3400 mm,激光跟踪干涉系统与约束直线的距离d=1700 mm,且位于约束直线的垂直平分线上。其余参数同表1,在约束直线上均匀等间选取约束点,约束点的数量N从10~80个点变化,分别计算标定误差与约束点个数的皮尔逊相关系数r,以此衡量约束点个数与标定误差的相关性。一般情况下,皮尔逊系数|r| < 0.3则认为他们没有相关性,仿真得到的皮尔逊相关系数r=0.045,所以当约束点大于10个之后,理论上约束点个数并不影响标定结果。为了保证结果的准确性与稳定性,采用了20个约束点进行实验和仿真。

      3)激光跟踪干涉系统的位置P0对标定精度的影响

      为了研究激光跟踪干涉系统在x轴方向上的位置对标定精度的影响,选取约束点数量N=20个,约束直线长度L = 3400 mm,激光跟踪干涉系统与约束直线的距离d=1700 mm,激光跟踪干涉系统的x坐标沿约束直线方向变化,仿真结果如图4所示,当激光跟踪干涉系统位置的x坐标在1700 mm附近时,标定误差有最小值,即约束点要相对于激光跟踪干涉系统对称分布。

      图  4  LTIS位置对标定误差的影响

      Figure 4.  Influence of LTIS position on calibration error

      根据优化分析结果,结合实际实验条件,文中使用如下参数进行基点标定:约束直线长度为3400 mm,激光跟踪干涉系统与约束直线的垂直距离为1700 mm;约束点数量为20个,激光跟踪干涉系统放置在约束直线的垂直平分线附近,使约束点关于激光跟踪干涉系统大致对称分布。

    • 搭建实验系统对激光跟踪干涉系统的基点距离进行标定,如图5所示。雷尼绍XL80干涉仪7固定在气浮导轨4一端,调节角锥棱镜6与雷尼绍XL80干涉仪下的4维平台使XL80干涉仪准直。激光跟踪干涉系统2放置在气度导轨的垂直平分线附近,激光跟踪干涉系统与气浮导轨的距离为1700 mm。控制气浮导轨、激光跟踪干涉系统和雷尼绍XL80干涉仪示数归零。然后将目标靶镜5利用磁吸底座固定在基点靶座3上,使能激光跟踪干涉系统跟踪目标靶镜,将靶镜移动到气浮导轨上开始测量。

      图  5  基点距离标定实验系统

      Figure 5.  Experimental system of DBP calibration

      约束直线长度L=3400 mm,约束点个数N=20,激光跟踪干涉系统与约束直线的垂直距离d=1700 mm,激光跟踪干涉系统的位置在约束直线的垂直平分线附近,重复测量5次。实验结果如表2所示,激光跟踪干涉系统的基点距离平均值为290.0764 mm。

      表 2  对激光跟踪干涉系统的基点距离标定结果

      Table 2.  DBP calibration result for LTIS

      No.DBP/mmAverage x0/mmAverage l0/mm
      1290.06881492.0213290.0764
      2290.0857
      3290.0748
      4290.0652
      5290.0877

      由于测量误差传播,最小二乘估计量的标准差取决于测量数据的标准差,由于每次测量的误差不同,这5次测量得到的最小二乘估计量的标准差也不同。根据最小二乘法的精度估计理论,可以求出每次测量中最小二乘估计量l0的标准差$ \sigma_{b_{0}} $。5次测量为不等精度测量,根据算数平均值原理,可以确定每组数据的权重$ p_{i} $,求出加权平均值$\overline l_0 $和加权平均值的标准差$ \sigma_{{\overline l_0}} $,经过计算,每次测量的标准差、权重、加权平均值和加权平均值的标准差如表3所示,激光跟踪干涉系统基点距离的平均值为29.0764 mm,算数平均值的标准差为4.4 μm。

      表 3  基点距离的加权平均值与平均值的标准差

      Table 3.  Weight average and its standard deviation of DBP

      12345
      $ \sigma_{\|} $0.05020.11280.05110.05590.0473
      $ p_{i} $397.578.666382.44319.62446.27
      $ \bar{l}_{0} $29.0764 mm
      $ \sigma_{T_{1}} $4.4 μm
    • 为了验证激光跟踪干涉系统基点距离标定结果的准确性,使用文中标定方法对API radian跟踪仪的基点距离进行标定,并与其标称值进行比较。约束直线长度L=3400 mm约束点数量N=20,API radian跟踪仪放置在约束直线的垂直平分线附近,API radian跟踪仪与约束直线的垂直距离d=1700 mm。实验系统如图6所示。对基点距离进行5次标定,取其加权平均值并计算加权平均值的标准差。API基点距离的标称值为154.1910 mm,标定结果如表4所示。对API跟踪仪的基点距离标定的结果为154.1940 mm,与其标称值相差3 μm。API 的全程3D空间精度为 10 μm+5 μm/m,实验结果表明,激光跟踪干涉系统基点的直线约束标定方法可以准确地对基点距离进行标定。

      图  6  (a) 空气折射率补偿装置;(b) 标定验证实验系统;(c) API跟踪仪

      Figure 6.  (a) Air refractive index compensation; (b) The verification experimental system of calibration; (c) API tracker

      表 4  API radian跟踪仪基点距离标定结果

      Table 4.  DBP calibration results for API radian

      No. DBP/mmWeighted average
      /mm
      API value/mmError
      /mm
      1154.2002154.1940154.19100.003
      2154.1892
      3154.1993
      4154.1868
      5154.1968
    • 文中提出了一种激光跟踪干涉系统基点的直线约束标定方法,该方法在标定中仅使用了激光干涉仪与导轨,具有原理简单、精度高、误差源少的特点;分析了标定方法中各参数对基点距离标定精度的影响,确定了合适的约束直线长度L、激光跟踪干涉系统与约束直线的距离d、约束点个数N、激光跟踪干涉系统的位置P0,减小标定误差。

      利用激光跟踪干涉系统基点的直线约束标定方法对激光跟踪干涉系统的基点进行标定,该方法标定的激光跟踪干涉系统的基点距离的平均值为$\overline l_0 $=290.0764 mm,标准差为4.4 μm,对API radian跟踪仪的基点距离进行标定来验证标定结果的准确性,与标称值相比误差为3 μm。因此,文中激光跟踪干涉系统基点的直线约束标定方法标定出的基点距离精度满足工业机器人的标定需求,对工业机器人发展具有重要的意义。

参考文献 (17)

目录

    /

    返回文章
    返回