Coordinate unification between treatment room and the robot system of Heavy Ion Medical Machine
-
摘要: 治疗室与其机器人是重离子治疗装置(HIMM)精准治疗系统的重要组成部分,为了提升重离子放疗过程中患者摆位的精度和效率,研究一种使用激光跟踪仪和其配套软件SA将运载治疗床的机器人基座坐标系与治疗室坐标系统一的方法,通过图形拟合的方法确定了标定点在法兰盘坐标系中的坐标;通过数学模型的搭建完成了机器人法兰盘坐标系和基座标系之间的坐标变换;利用SA软件中最佳拟合算法求出了治疗室坐标系与机器人坐标系之间的变换矩阵,完成了坐标系的统一。在HIMM中的实际应用表明,坐标系的统一方法的使用不但简化了标定点在法兰盘中心坐标系中坐标的标定,简化了法兰盘中心坐标系和基座标系转换的计算过程,而且标定精度良好、效率更高,更加符合重离子精准治疗系统及其他工业应用。Abstract: To accurately locate patients in the process of heavy ion therapy for cancer, a method of coordinate unification between treatment room and the robot system of heavy ion therapy system based on the laser tracker and its supporting software Spatial Analyzer is proposed. First, we determine the coordinates of the calibration point in the flange center coordinate system by geometric fitting method. Second, the coordinate transformation between the robot flange coordinate system and the base coordinate system is accomplished by simple calculation. Finally, the transformation matrix between the treatment room coordinate system and the robot coordinate system is calculated by using the best fitting algorithm in Spatial Analyzer software. The unification of the coordinate system is completed, and the accuracy of the unified coordinate system is verified. The practical application in HIMM (Heavy Ion Medical Machine) shows that the coordinate unification method simplifies the conversion between treatment room and the robot system of heavy ion therapy system. Moreover, the calibration accuracy is good and the calibration efficiency is high. This method of coordinate unification is easy to operate in heavy ion therapy system and other industrial applications.
-
Key words:
- Heavy Ion Medical Machine /
- treatment room /
- robot /
- coordinate transformation /
- laser tracker
-
表 1 示教器上法兰盘中心位姿参数
Table 1. Center position parameters of the flange on the teach pendant
No. x/mm y/mm z/mm A/(°) B/(°) C/(°) $ {P}_{{\rm{B}}}^{{\rm{E}}}1 $ 764.93 1378.01 −2187.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}2 $ 964.93 1378.01 −2187.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}3 $ 964.93 1578.01 −2187.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}4 $ 764.93 1578.01 −2187.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}5 $ 564.93 1578.01 −2187.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}6 $ 564.93 1378.01 −2187.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}7 $ 564.93 1178.01 −2187.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}8 $ 764.93 1178.01 −2187.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}9 $ 964.93 1178.01 −2187.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}10 $ 964.93 1178.01 −1987.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}11 $ 964.93 1378.01 −1987.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}12 $ 964.93 1578.01 −1987.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}13 $ 764.93 1578.01 −1987.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}14 $ 564.93 1578.01 −1987.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}15 $ 564.93 1378.01 −1987.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}16 $ 564.93 1178.01 −1987.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}17 $ 764.93 1178.01 −1987.06 0 0 0 $ {P}_{{\rm{B}}}^{{\rm{E}}}1 $8 764.93 1378.01 −1987.06 0 0 0 表 2 标定点在治疗室{ISO}坐标系中的坐标
Table 2. Coordinates of the calibration point in the ISO coordinate system of the treatment room
No. x/mm y/mm z/mm $ {P}_{{\rm{ISO}}} $1 −817.51 −638.78 −485.96 $ {P}_{{\rm{ISO}}} $2 −1017.28 −639.84 −485.32 $ {P}_{{\rm{ISO}}} $3 −1016.9 −640.17 −285.34 $ {P}_{{\rm{ISO}}} $4 −817.03 −639.09 −285.97 $ {P}_{{\rm{ISO}}} $5 −617.22 −637.97 −286.48 $ {P}_{{\rm{ISO}}} $6 −617.58 −637.71 −486.5 $ {P}_{{\rm{ISO}}} $7 −617.95 −637.39 −686.42 $ {P}_{{\rm{ISO}}} $8 −817.79 −638.49 −685.91 $ {P}_{{\rm{ISO}}} $9 −1017.65 −639.55 −685.27 $ {P}_{{\rm{ISO}}} $10 −1018.77 −439.62 −684.97 $ {P}_{{\rm{ISO}}} $11 −1018.44 −439.89 −484.95 $ {P}_{{\rm{ISO}}} $12 −1017.99 −440.14 −285.03 $ {P}_{{\rm{ISO}}} $13 −818.09 −439.06 −285.59 $ {P}_{{\rm{ISO}}} $14 −618.24 −438.03 −286.13 $ {P}_{{\rm{ISO}}} $15 −618.62 −437.72 −486.17 $ {P}_{{\rm{ISO}}} $16 −619 −437.44 −686.15 $ {P}_{{\rm{ISO}}} $17 −818.92 −438.51 −685.54 $ {P}_{{\rm{ISO}}} $18 −818.58 −438.8 −485.58 表 3 标定点在机器人基座标系下的坐标
Table 3. Coordinates of the calibration point under the robot base system
No. x/mm y/mm z/mm $ {P}_{{\rm{B}}} $1 916.26 1122.57 −1930.1 $ {P}_{{\rm{B}}} $2 1116.26 1122.57 −1930.1 $ {P}_{{\rm{B}}} $3 1116.26 1322.57 −1930.1 $ {P}_{{\rm{B}}} $4 916.26 1322.57 −1930.1 $ {P}_{{\rm{B}}} $5 716.26 1322.57 −1930.1 $ {P}_{{\rm{B}}} $6 716.26 1122.57 −1930.1 $ {P}_{{\rm{B}}} $7 716.26 922.57 −1930.1 $ {P}_{{\rm{B}}} $8 916.26 922.57 −1930.1 $ {P}_{{\rm{B}}} $9 1116.26 922.57 −1930.1 $ {P}_{{\rm{B}}} $10 1116.26 922.57 −1730.1 $ {P}_{{\rm{B}}} $11 1116.26 1122.57 −1730.1 $ {P}_{{\rm{B}}} $12 1116.26 1322.57 −1730.1 $ {P}_{{\rm{B}}} $13 916.26 1322.57 −1730.1 $ {P}_{{\rm{B}}} $14 716.26 1322.57 −1730.1 $ {P}_{{\rm{B}}} $15 716.26 1122.57 −1730.1 $ {P}_{{\rm{B}}} $16 716.26 922.57 −1730.1 $ {P}_{{\rm{B}}} $17 916.26 922.57 −1730.1 $ {P}_{{\rm{B}}} $18 916.26 1122.57 −1730.05 表 4 坐标转换精度
Table 4. Coordinate conversion accuracy
Δxmax/mm δRMS-x Δymax/mm δRMS-y Δzmax/mm δRMS-z ΔMag-max/mm ΔRMS-mag/mm 0.26 0.14 0.06 0.03 0.15 0.09 0.3 0.16 -
[1] 陈文军, 马力祯, 蔡国柱, 等. 武威重离子治癌装置高能束线的准直安装[J]. 强激光与粒子束, 2015, 27:085102 doi: 10.11884/HPLPB201527.085102Chen Wenjun, Ma Lizhen, Cai Guozhu, et al. Alignment of high energy line for Wuwei Heavy Ion Medical Machine[J]. High Power Laser and Particle Beams, 2015, 27: 085102 doi: 10.11884/HPLPB201527.085102 [2] 张远月. 质子重离子治疗过程中的机器人定位精度控制技术研究[J]. 机电信息, 2017(15):96-99Zhang Yuanyue. Research on robot positioning accuracy control technology during proton heavy ion therapy[J]. Mechanical and Electrical Information, 2017(15): 96-99 [3] 张博, 魏振忠, 张广军. 机器人坐标系与激光跟踪仪坐标系的快速转换方法[J]. 仪器仪表学报, 2010, 31(9):1986-1990Zhang Bo, Wei Zhenzhong, Zhang Guangjun. Rapid coordinate transformation between a robot and a laser tracker[J]. Chinese Journal of Scientific Instrument, 2010, 31(9): 1986-1990 [4] 冯晓波. 机器人准确制孔技术研究[D]. 杭州: 浙江大学, 2011: 45-50Feng Xiaobo. Research on robot precision drilling[D]. Hangzhou: Zhejiang University, 2011: 45-50 [5] 齐立哲, 陈磊, 王伟, 等. 基于激光跟踪仪的机器人误差测量系统标定[J]. 制造技术与机床, 2012(10):90-94 doi: 10.3969/j.issn.1005-2402.2012.10.028Qi Lizhe, Chen Lei, Wang Wei, et al. The calibration for industrial robot’s position error measuring system based on the laser tracker[J]. Manufacturing Technology & Machine Tool, 2012(10): 90-94 doi: 10.3969/j.issn.1005-2402.2012.10.028 [6] 向民志, 范百兴, 李祥云, 等. 激光跟踪仪与机器人坐标系转换方法研究[J]. 航空制造技术, 2018, 61(1/2):98-101Xiang Minzhi, Fan Baixing, Li Xiangyun, et al. Study on coordinate transformation between a laser tracker and a robot[J]. Aeronautical Manufacturing Technology, 2018, 61(1/2): 98-101 [7] 徐福乾, 范百兴, 段童虎, 等. 快速转换激光跟踪仪与机器人坐标系的方法[J]. 信息工程大学学报, 2022, 23(2):179-183Xu Fuqian, Fan Baixing, Duan Tonghu, et al. Rapid coordinate transformation method between a laser tracker and a robot[J]. Journal of Information Engineering University, 2022, 23(2): 179-183 [8] 徐福乾, 范百兴, 黄赫, 等. 激光跟踪仪与机器人坐标转换公共点的选取方法[J]. 测绘工程, 2022, 31(3):31-39Xu Fuqian, Fan Baixing, Huang He, et al. Common point selection in coordinate transformation between a laser tracker and a robot.[J]. Engineering of Surveying and Mapping, 2022, 31(3): 31-39 [9] 蔡国柱. 大型离子加速器先进准直安装方法研究[D]. 北京: 中国科学院大学, 2014: 99-100Cai Guozhu. Research on alignment and installation of large ion accelerator[D]. Beijing: The University of Chinese Academy of Sciences, 2014: 99-100