计算机集成制造系统 ›› 2025, Vol. 31 ›› Issue (12): 4566-4574.DOI: 10.13196/j.cims.2024.Z01

• • 上一篇    下一篇

四位置敏感探测器空间位姿的同构变换标定法

苏成志1,2,3,巴麒蛟4,王文彪5,郑轶哲4   

  1. 1.长春理工大学人工智能学院
    2.长春理工大学吉林省智能机器人高校协同创新中心
    3.长春理工大学智能复合机器人吉林省校企联合技术创新实验室
    4.长春理工大学机电工程学院
    5.长春设备工艺研究所
  • 出版日期:2025-12-31 发布日期:2026-01-08
  • 作者简介:
    苏成志(1977-),男,吉林长春人,教授,博士生导师,研究方向:智能机器人技术及应用研究,E-mail:chengzhi_su@126.com;

    巴麒蛟(2000-),男,吉林四平人,硕士研究生,研究方向:智能机器人标定,E-mail:771491678@qq.com;

    王文彪(1981-),男,吉林长春人,工程师,研究方向:机械设计理论,E-mail:929304318@qq.com;

    郑轶哲(1999-),男,浙江绍兴人,硕士研究生,研究方向:智能机器人标定,E-mail:911098473@qq.com。
  • 基金资助:
    吉林省科技发展计划资助项目(YDZJ202503CGZH002);国防基础科研计划资助项目(JCKY2019411B001);长春市科技发展计划资助项目(24GXYSZZ14)。

Calibration method for isomorphic transformation of spatial pose of four-position sensitive detectors

SU Chengzhi1,2,3,BA Qijiao4,WANG Wenbiao5,ZHENG Yizhe4   

  1. 1.School of Artificial Intelligence,Changchun University of Science and Technology
    2.Jilin Provincial Intelligent Robot University Collaborative Innovation Center,Changchun University of Science and Technology
    3.Jilin Provincial University-Enterprise Joint Technical Innovation Laboratory for Intelligent Composite Robots,Changchun University of Science and Technology
    4.School of Mechanical and Electrical Engineering,Changchun University of Science and Technology
    5.Changchun Institute of Equipment and Technology
  • Online:2025-12-31 Published:2026-01-08
  • Supported by:
    Project supported by the Jilin Provincial Science and Technology Development Plan,China(No.YDZJ202503CGZH002),the National Defense Basic Research Program,China(No.JCKY2019411B001),and the Science and Technology Development Plan of Changchun City,China(No.24GXYSZZ14).

摘要: 针对四位置敏感探测器(PSD)的空间位姿标定测量过程中存在平移和旋转误差耦合问题,提出一种基于同构变换的4-PSD测量阵列空间位姿标定方法。首先使用激光跟踪仪测量固接在4-PSD测量阵列上的三靶球A、B、C坐标,同时采集激光束投影到4-PSD测量阵列上的光斑P1、P2、P3、P4坐标;移动4-PSD测量阵列,再次记录三靶球An、Bn、Cn坐标和光斑Pn1、Pn2、Pn3、Pn4坐标;根据4-PSD测量阵列移动前后位姿矩阵相似迹相等的性质构建约束方程f,采用粒子群优化算法对f求解。机器人定位精度试验表明:基于4-PSD测量阵列标定后的机器人位置精度提升了66.27%,姿态精度(航向角、俯仰角、横滚角)分别提升了61.58%、68.69%和69.35%。与已有方法相比,位置精度最大提升了1.71%,姿态精度最大提升了51.57%。

关键词: 位姿标定, 位置敏感探测器, 同构变换, 非线性最小二乘法

Abstract: In the process of spatial pose calibration measurement for the four-position sensitive detector Position Sensitive Detector(PSD),there is a coupling problem of translation and rotation errors.For this problem,a spatial pose calibration method for 4-PSD array based on isomorphic transformation was proposed.A laser tracker was used to measure the coordinates of the three target spheres A,B,C fixed on the 4-PSD array,and the laser beam was collected and projected onto the spot coordinates P1,P2,P3,P4on the 4-PSD array at the same time.The 4-PSD array were moved,and the coordinates A,B,C of the three target spheres and the coordinates of P1,P2,P3,P4were recorded again.The constraint equation was constructed according to the property that the pose matrix before and after the movement of the 4-PSD measurement array wasequal in similarity,the particle swarm optimization algorithm was used to solve for f.The test of robot positioning accuracy showed that the position accuracy of the robot based on the calibration of the 4-PSD array was improved by 66.27%.The attitude accuracy(heading angle,pitch angle and roll angle) increased by 61.58%,68.69% and 69.35% respectively.Compared with existing methods,the maximum improvement in position accuracy was 1.71%,while the maximum improvement in pose accuracy was 51.57%.

Key words: pose calibration, position-sensitive detector, isomorphic transformation, nonlinear least squares

中图分类号: