Cable Vector Collision Detection Algorithm for Multi-Robot Collaborative Towing System

doi:10.1007/s12204-023-2592-0

Abstract

Abstract: For the process of multi-robot collaboration to lift the same lifted object by flexible cables, the existing collision detection algorithm of cables between the environmental obstacles has the problem of misjudgment and omission. In this work, the collision detection of cable vector was studied, and the purpose of collision detection was realized by algorithm. Considering the characteristics of cables themselves, based on oriented bounding box theory, the cable optimization model and environmental obstacle model were established, and a new basic geometric collision detection model was proposed. Then a fast cable vector collision detection algorithm and an optimization principle were proposed. Finally, the rationality of the cable collision detection model and the effectiveness of the proposed algorithm were verified by simulation. Simulation results show that the proposed method can meet the requirements of the fast detection and the accuracy in complex virtual environment. The results lay a foundation for obstacle avoidance motion planning of system.

Key words: multi-robot system, bounding box, cable-driven, collision detection

摘要： 针对多台机器人通过柔性绳索协调吊运同一被吊运物的过程中，现有的绳索与环境障碍物碰撞检测算法存在误判和漏判问题，本文研究了绳索矢量的碰撞检测，通过算法实现碰撞检测目的。考虑绳索自身特性，基于有向包围盒理论，建立了绳索优化模型与环境障碍物模型，提出新的基本几何碰撞检测模型。在此基础上，提出一种绳索矢量碰撞快速检测算法和优化原则。最后，通过仿真验证了绳索碰撞检测模型的合理性和所提算法的有效性。仿真结果表明，该方法能够满足快速检测原则和复杂虚拟环境下的精度要求。研究结果为系统避障运动规划奠定了基础。

关键词: 多机器人系统，包围盒，绳牵引，碰撞检测

CLC Number:

TP242.2

Li Tao, Zhao Zhigang, Zhu Mingtong, Zhao Xiangtang. Cable Vector Collision Detection Algorithm for Multi-Robot Collaborative Towing System[J]. J Shanghai Jiaotong Univ Sci, 2025, 30(2): 319-329.

References

[1] MING A, HIGUCHI T. Study on multiple degree of freedom positioning mechanisms using wires (Part 1): Concept, design and control [J]. International Journal of the Japan Society for Precision Engineering, 1994, 28(2): 131-138.
[2] TADOKORO S, MURAO Y, HILLER M, et al. A motion base with 6-DOF by parallel cable drive architecture [J]. IEEE/ASME Transactions on Mechatronics, 2002, 7(2): 115-123.
[3] MERLET J P. Analysis of the influence of wires interference on the workspace of wire robots [M]//On advances in robot kinematics. Dordrecht: Springer, 2004: 211-218.
[4] NGUYEN D Q, GOUTTEFARDE M. On the improvement of cable collision detection algorithms [M]//Cable-driven parallel robots. Cham: Springer, 2014: 29-40.
[5] KUMAR T R V A, RICHARDSON R C. Entanglement detection of a swarm of tethered robots in search and rescue applications [M]//Proceedings of the fourth international conference on informatics in control, automation and robotics. Angers: SciTePress-Science and and Technology Publications, 2007: 143-148.
[6] KUMAR T R V A, RICHARDSON R C. Tether monitoring techniques for environment monitoring, tether following and localization of autonomous mobile robots [C]//2008 IEEE/RSJ International Conference on Intelligent Robots and Systems. Nice: IEEE, 2008: 2109- 2114.
[7] SU Y, QIU Y Y. Derivation of complete interference conditions for wire-driven parallel robots [J]. Journal of Mechanical Engineering, 2011, 47(15): 44-51 (in Chinese).
[8] MCGAREY P, MACTAVISH K, POMERLEAU F, et al. The line leading the blind: Towards nonvisual localization and mapping for tethered mobile robots [C]//2016 IEEE International Conference on Robotics and Automation. Stockholm: IEEE, 2016: 4799-4806.
[9] MERLET J P. Analysis of the influence of wires interference on the workspace of wire robots [M]//On advances in robot kinematics. Dordrecht: Springer, 2004: 211-218.
[10] PERREAULT S, GOSSELIN C M. Cable-driven parallel mechanisms: Application to a locomotion interface [C]//ASME 2007 International Design Engineering Technical Conferences and Computers and Information in Engineering Conference. Las Vegas: ASME, 2009: 791-799.
[11] HUANG R N, TANG T Y, LOU Y J, et al. A collision detection algorithm of robot in off-line programming system [C]//2014 4th IEEE International Conference on Information Science and Technology. Shenzhen: IEEE, 2014: 349-353.
[12] KONG M X, YU G D. Collision detection algorithm for dual-robot system [C]//2014 IEEE International Conference on Mechatronics and Automation. Tianjin: IEEE, 2014: 2083-2088.
[13] SHEN Y, JIA Q X, CHEN G, et al. Study of rapid collision detection algorithm for manipulator [C]//2015 IEEE 10th Conference on Industrial Electronics and Applications. Auckland: IEEE, 2015: 934-938.
[14] SU C, YE J N, LI W, et al. Analysis of dynamic workspace for under-constrained coordinate suspending system with multi-robots [J]. Journal of Shanghai Jiao Tong University, 2019, 53(2): 225-231 (in Chinese).
[15] ZHAO Z G, TENG F J, SHI G T, et al. Analysis and calculation of feasible region of multi-robot combined lifting system [J]. Journal of Shanghai Jiao Tong University, 2015, 49(8): 1174-1180 (in Chinese).
[16] WANG Y L, ZHAO Z G, SU C, et al. Analysis of the workspace and dynamic stability of a multi-robot collaboratively towing system [J]. Journal of Vibration and Shock, 2017, 36(16): 44-50 (in Chinese).
[17] ZHAO Z G, TENG F J, SHI G T, et al. The inverse kinematics analysis of multi-robot combined lifting system [J]. Journal of Harbin Engineering University, 2016, 37(2): 254-260 (in Chinese).
[18] LIANG X X, ZHAO Z G, SU C, et al. Trajectory tracking control of multi-robot parallel coordinated towing system [J]. Computer Simulation, 2018, 35(4): 295-300 (in Chinese).
[19] WANG R, HUA W, XU G, et al. Variational hierarchical directed bounding box construction for solid mesmodels [DB/OL]. (2022-05-20). https://arxiv.org/abs/2203.10521.