Kinematics Analysis and Positioning Solution of Three Degrees of Freedom Manipulator for Eddy Current Inspection of SG Heat Transfer Tube
-
摘要: 蒸汽发生器传热管的在役自动涡流检验装置对定位器的定位精度要求较高，定位偏差使得探头磨损加剧甚至卡在传热管中。为了解决定位的精确计算问题，本文基于三自由度的检测机械臂，建立了机械臂关节的运动学模型，对正、逆运动学进行了定位计算求解，同时为解决安装机械臂时基座的位置偏差提出了误差消除的方法。试验结果表明，该定位计算方法的结果准确、稳定可靠。Abstract: In-service automatic eddy current inspection device for heat transfer tube of steam generator requires high positioning accuracy. If positioning deviation exists, the probe will wear worse or even get stuck in the heat transfer tube. In order to solve the problem, based on the three degrees of freedom detection manipulator, the kinematics model of the manipulator joint is established, and the forward and inverse kinematics are solved in this paper. Besides, the method of error elimination is proposed for solving the position deviation of the base when installing the manipulator. The test results show that the positioning calculation method is accurate, stable and reliable.
-
图 1 三自由度检测机械臂结构示意图
Figure 1. Structure of Three-degree of Freedom Detection Manipulator
图 2 建立坐标系
l1—大臂长度； l2—小臂长度；θ1—大臂旋转角度；θ2—小臂旋转角度
Figure 2. Establishment of Coordinate System
表 1 27组管子机械臂定位测试结果
Table 1. Test Results of Manipulator Positioning for 27 Groups of Tubes
管号
（ROW,COL）Rn/mm Cn /mm ER/mm EC/mm (46,29) 0 0 0 0 (46,30) 30.21 29 2.78 1.57 (46,31) 30.21 28 2.78 0.57 (46,32) 30.21 27 2.78 −0.43 (46,33) 29.21 28 1.78 0.57 (46,34) 30.21 27 2.78 −0.43 (46,35) 29.21 26 1.78 −1.43 (46,36) 28.21 26 0.78 −1.43 (46,37) 28.21 27 0.78 −0.43 (46,38) 29.21 29 1.78 1.57 (46,39) 28.21 27 0.78 −0.43 (46,40) 28.21 27 0.78 −0.43 (46,41) 28.21 27 0.78 −0.43 (46,42) 29.21 29 1.78 1.57 (46,43) 29.21 29 1.78 1.57 (46,44) 28.21 28 0.78 0.57 (46,45) 27.21 28 −0.22 0.57 (46,46) 27.21 26 −0.22 −1.43 (46,47) 25.21 30 −2.22 2.57 (46,48) 24.65 29 −2.78 1.57 (46,49) 25.21 30 −2.22 2.57 (46,50) 24.65 28 −2.78 0.57 (46,51) 25 28 −2.43 0.57 (46,52) 25 27 −2.43 −0.43 (46,53) 25 29 −2.43 1.57 (46,54) 24.91 27 −2.52 −0.43 (46,55) 24.91 30 −2.52 2.57 平均偏差 0.07 0.49 
下载: 导出CSV
-
[1] 彭思桐,吕云鹤,曾珍,等. 基于卧式蒸汽发生器传热管涡流检查数据的堵管准则研究[J]. 核安全,2022, 21(3): 70-76. doi: 10.3969/j.issn.1672-5360.2022.3.haq202203011 [2] 张军,顾波,杨宏博,等. 核电厂蒸汽发生器传热管涡流检测噪声形成机制与测量[J]. 核动力工程,2016, 37(6): 134-137. doi: 10.13832/j.jnpe.2016.06.0134 [3] ZETEC. ZR-100 OVERVIEW[EB/OL]. (2022-10-10) [2023-07-26]. https://www.zetec.com/products/mechanical-systems/probe-delivery/zr-100/. [4] 韩捷,廖述圣,高厚秀,等. 核电站蒸汽发生器传热管涡流自动检测系统研制[J]. 机械与电子,2018, 36(6): 58-61. doi: 10.3969/j.issn.1001-2257.2018.06.014 [5] 唐翠微. 基于模糊逻辑控制算法的混联机械臂最优运动轨迹规划[J]. 机械设计与制造工程,2021, 50(7): 29-34. doi: 10.3969/j.issn.2095-509X.2021.07.006 [6] STARKE S, HENDRICH N, MAGG S, et al. An efficient hybridization of genetic algorithms and particle swarm optimization for inverse kinematics[C]//2016 IEEE International Conference on Robotics and Biomimetics (ROBIO). Qingdao, China: IEEE, 2016: 1782-1789. [7] 赵京,龚世秋,张自强. 7自由度拟人臂仿人运动的逆运动学解析解[J]. 机械工程学报,2018, 54(21): 25-32. -
图(4) / 表(1)
计量
- 文章访问数: 97
- HTML全文浏览量: 20
- PDF下载量: 78
- 被引次数: 0
