Collision Detection of Robotic Manipulators with Feedback Current
-
摘要: 本文以机械臂碰撞检测为研究对象, 提出了一种基于电流变化速度的碰撞检测方法, 弥补动力学模型理论电流的碰撞检测方法存在参数辨识过程复杂、对动力学模型精度要求高等缺点。试验发现在机械臂有碰撞的时候会产生电流突变, 当电流变化速度大于给定的阈值时就判定有碰撞。通过大量试验发现电机不同转速下电流变化速度的阈值也不同, 于是提出电机转速的阈值检测方法, 用电机转速拟合关系式计算出电机在不同转速下的阈值, 从而判断电机在不同转速下是否存在碰撞。最终的碰撞检测试验结果表明, 当碰撞发生时, 机械臂可以快速检测到碰撞并做出相应反应, 达到预期目标。Abstract: This paper takes the robot arm collision detection as the research object. A collision detection method based on current change speed is proposed, which makes up for the shortcomings of imperfect dynamic model and complex parametric identifying. The test found that there is a sudden current change when the manipulator is in collision. Judge it as a collision when the current change rate is greater than a given threshold. The test found that the threshold of the current change rate at different speeds of the motor is also different. Therefore, a threshold detection method for motor speed is proposed to calculate the threshold of the motor at different speeds with the motor speed fitting relationship. Therefore, it is judged whether the motor has a collision at different rotation speeds. The final collision detection experiment results show that when the collision occurs, the robot arm can quickly detect the collision and make corresponding response, achieving the expected goal.
-
Key words:
- collision detection /
- dynamic model /
- manipulator /
- current feedback
-
表 1 电机不同转速下的碰撞阈值
转速/(°·s-1) 阈值/mA 10 0.58 20 0.73 30 0.98 40 1.13 50 1.33 60 1.58 70 1.76 80 1.96 90 2.23 -
[1] 邹风山, 赵彬. 基于电流的力控制技术与安全保护研究[J]. 组合机床与自动化加工技术, 2017(8): 100-104 https://www.cnki.com.cn/Article/CJFDTOTAL-ZHJC201708025.htmZOU F S, ZHAO B. Autonomous mobile robot map building, localization and path planning[J]. Modular Machine Tool & Automatic Manufacturing Technique, 2017(8): 100-104 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-ZHJC201708025.htm [2] HADDADIN S, HIRZINGER G. Requirements for safe robots: measurements, analysis and new insights[M]. Sage Publications, Inc., 2009 [3] 赵汉杰. 机械臂的碰撞检测研究[D]. 哈尔滨: 哈尔滨工业大学, 2017ZHAO H J. Collision detection of robotic manipulators[D]. Harbin: Harbin Institute of Technology, 2017 (in Chinese) [4] LU S J, CHUNG J H, VELINSKY S A. Human-robot collision detection and identification based on wrist and base force/torque sensors[C]//Proceedings of 2005 IEEE International Conference on Robotics and Automation. Barcelona, Spain: IEEE, 2005: 3796-3801 [5] CIRILLO A, CIRILLO P, DE MARIA G, et al. A proximity/contact-force sensor for human safety in industrial robot environment[C]//Proceedings of 2013 IEEE/ASME International Conference on Advanced Intelligent Mechatronics. Wollongong, Australia: IEEE, 2013: 1272-1277 [6] KIM J, ALSPACH A, YAMANE K. 3D printed soft skin for safe human-robot interaction[C]// Proceedings of 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems. Hamburg, Germany: IEEE, 2015: 2419-2425 [7] LAMY X, COLLEDANI F, GEFFARD F, et al. Robotic skin structure and performances for industrial robot comanipulation[C]// Proceedings of 2009 IEEE/ASME International Conference on Advanced Intelligent Mechatronics. Singapore: IEEE, 2009: 427-432 [8] DINH K H, OGUZ O, HUBER G, et al. An approach to integrate human motion prediction into local obstacle avoidance in close human-robot collaboration[C]// Proceedings of 2015 IEEE International Workshop on Advanced Robotics and ITS Social Impacts. Lyon, France: IEEE, 2015: 1-6 [9] OHNISHI K, SHIBATA M, MURAKAMI T. Motion control for advanced mechatronics[J]. IEEE/ASME Transactions on Mechatronics, 1996, 1(1): 56-67 doi: 10.1109/3516.491410 [10] 肖聚亮, 田志伟, 洪鹰, 等. 一种轻型模块化协作机器人碰撞检测算法[J]. 天津大学学报, 2017, 50(11): 1140-1147 https://www.cnki.com.cn/Article/CJFDTOTAL-TJDX201711004.htmXIAO J L, TIAN Z W, HONG Y, et al. Collision detection algorithm for light and modular cooperative robots[J]. Journal of Tianjin University, 2017, 50(11): 1140-1147 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-TJDX201711004.htm [11] 张雪源. 服务机器人关节力柔顺控制研究[D]. 武汉: 湖北工业大学, 2019ZHANG X Y. Research on joint force compliance control of service robot[D]. Wuhan: Hubei University of Technology, 2019 [12] SOUSA C D, CORTESÃO R. Physically feasible dynamic parameter identification of the 7-DOF WAM robot[C]//Proceedings of 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems. Tokyo, Japan: IEEE, 2014: 2868-2873 [13] 林呈辉, 杨洪耕, 袁锋. 基于αβ变换和自适应卡尔曼滤波的任意次谐波电流检测[J]. 现代电力, 2008, 25(4): 45-49 https://www.cnki.com.cn/Article/CJFDTOTAL-XDDL200804012.htmLIN C H, YANG H G, YUAN F. Random harmonic current detection based on αβ transform and adaptive Kalman filter[J]. Modern Electric Power, 2008, 25(4): 45-49 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-XDDL200804012.htm [14] 张铁, 林君健, 邹焱飚. 基于轨迹规划的机器人碰撞检测研究[J]. 机床与液压, 2012, 40(21): 12-14 https://www.cnki.com.cn/Article/CJFDTOTAL-JCYY201221007.htmZHANG T, LIN J J, ZOU Y B. Study on collision detection based on trajectory planning[J]. Machine Tool & Hydraulics, 2012, 40(21): 12-14 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JCYY201221007.htm [15] FLACCO F, KRÖGER T, DE LUCA A, et al. A depth space approach to human-robot collision avoidance[C]// Proceedings of 2012 IEEE International Conference on Robotics and Automation. Saint Paul, USA: IEEE, 2012: 338-345