Shenglong Nie, Bo Chen, Yichao Li, Dianzheng Wang, Yundou Xu
{"title":"基于碰撞检测的凿岩机械臂自主路径规划算法","authors":"Shenglong Nie, Bo Chen, Yichao Li, Dianzheng Wang, Yundou Xu","doi":"10.1002/rob.22596","DOIUrl":null,"url":null,"abstract":"<div>\n \n <p>In the field of high-redundancy manipulators, specifically in the rock drilling manipulator domain, fast and efficient path planning is crucial. Therefore, this paper proposes an improved algorithm, v-BI-RRT, based on the BI-RRT algorithm and oriented vector methods. In this algorithm, the nodes along one path are extended in the direction of the node coordinates of another path as the target direction. When the path collides with an obstacle, new node coordinates are generated using a random sampling method to bypass the obstacle. This approach enhances spatial search efficiency. For high-redundancy manipulators like the rock drilling manipulator, self-collision avoidance is a key component of collision-free path planning. This paper uses oriented bounding boxes (OBB) and capsules to envelope the manipulator's body. Potential self-collisions are detected in two stages: during the rapid detection phase, non-colliding pairs are quickly excluded, and during the precise detection phase, the distance between the remaining potential collision pairs is calculated using Euclidean distance to find the shortest distance. Finally, the self-collision detection algorithm is integrated into the v-BI-RRT algorithm. Simulations and experiments demonstrate that the algorithm responds quickly and performs well in avoiding collisions when applied to path planning for the rock drilling manipulator.</p>\n </div>","PeriodicalId":192,"journal":{"name":"Journal of Field Robotics","volume":"42 7","pages":"3918-3934"},"PeriodicalIF":5.2000,"publicationDate":"2025-06-11","publicationTypes":"Journal Article","fieldsOfStudy":null,"isOpenAccess":false,"openAccessPdf":"","citationCount":"0","resultStr":"{\"title\":\"The Autonomous Route Planning Algorithm for Rock Drilling Manipulator Based on Collision Detection\",\"authors\":\"Shenglong Nie, Bo Chen, Yichao Li, Dianzheng Wang, Yundou Xu\",\"doi\":\"10.1002/rob.22596\",\"DOIUrl\":null,\"url\":null,\"abstract\":\"<div>\\n \\n <p>In the field of high-redundancy manipulators, specifically in the rock drilling manipulator domain, fast and efficient path planning is crucial. Therefore, this paper proposes an improved algorithm, v-BI-RRT, based on the BI-RRT algorithm and oriented vector methods. In this algorithm, the nodes along one path are extended in the direction of the node coordinates of another path as the target direction. When the path collides with an obstacle, new node coordinates are generated using a random sampling method to bypass the obstacle. This approach enhances spatial search efficiency. For high-redundancy manipulators like the rock drilling manipulator, self-collision avoidance is a key component of collision-free path planning. This paper uses oriented bounding boxes (OBB) and capsules to envelope the manipulator's body. Potential self-collisions are detected in two stages: during the rapid detection phase, non-colliding pairs are quickly excluded, and during the precise detection phase, the distance between the remaining potential collision pairs is calculated using Euclidean distance to find the shortest distance. Finally, the self-collision detection algorithm is integrated into the v-BI-RRT algorithm. Simulations and experiments demonstrate that the algorithm responds quickly and performs well in avoiding collisions when applied to path planning for the rock drilling manipulator.</p>\\n </div>\",\"PeriodicalId\":192,\"journal\":{\"name\":\"Journal of Field Robotics\",\"volume\":\"42 7\",\"pages\":\"3918-3934\"},\"PeriodicalIF\":5.2000,\"publicationDate\":\"2025-06-11\",\"publicationTypes\":\"Journal Article\",\"fieldsOfStudy\":null,\"isOpenAccess\":false,\"openAccessPdf\":\"\",\"citationCount\":\"0\",\"resultStr\":null,\"platform\":\"Semanticscholar\",\"paperid\":null,\"PeriodicalName\":\"Journal of Field Robotics\",\"FirstCategoryId\":\"94\",\"ListUrlMain\":\"https://onlinelibrary.wiley.com/doi/10.1002/rob.22596\",\"RegionNum\":2,\"RegionCategory\":\"计算机科学\",\"ArticlePicture\":[],\"TitleCN\":null,\"AbstractTextCN\":null,\"PMCID\":null,\"EPubDate\":\"\",\"PubModel\":\"\",\"JCR\":\"Q2\",\"JCRName\":\"ROBOTICS\",\"Score\":null,\"Total\":0}","platform":"Semanticscholar","paperid":null,"PeriodicalName":"Journal of Field Robotics","FirstCategoryId":"94","ListUrlMain":"https://onlinelibrary.wiley.com/doi/10.1002/rob.22596","RegionNum":2,"RegionCategory":"计算机科学","ArticlePicture":[],"TitleCN":null,"AbstractTextCN":null,"PMCID":null,"EPubDate":"","PubModel":"","JCR":"Q2","JCRName":"ROBOTICS","Score":null,"Total":0}
The Autonomous Route Planning Algorithm for Rock Drilling Manipulator Based on Collision Detection
In the field of high-redundancy manipulators, specifically in the rock drilling manipulator domain, fast and efficient path planning is crucial. Therefore, this paper proposes an improved algorithm, v-BI-RRT, based on the BI-RRT algorithm and oriented vector methods. In this algorithm, the nodes along one path are extended in the direction of the node coordinates of another path as the target direction. When the path collides with an obstacle, new node coordinates are generated using a random sampling method to bypass the obstacle. This approach enhances spatial search efficiency. For high-redundancy manipulators like the rock drilling manipulator, self-collision avoidance is a key component of collision-free path planning. This paper uses oriented bounding boxes (OBB) and capsules to envelope the manipulator's body. Potential self-collisions are detected in two stages: during the rapid detection phase, non-colliding pairs are quickly excluded, and during the precise detection phase, the distance between the remaining potential collision pairs is calculated using Euclidean distance to find the shortest distance. Finally, the self-collision detection algorithm is integrated into the v-BI-RRT algorithm. Simulations and experiments demonstrate that the algorithm responds quickly and performs well in avoiding collisions when applied to path planning for the rock drilling manipulator.
期刊介绍:
The Journal of Field Robotics seeks to promote scholarly publications dealing with the fundamentals of robotics in unstructured and dynamic environments.
The Journal focuses on experimental robotics and encourages publication of work that has both theoretical and practical significance.