基于末端杆件螺旋运动的凿岩机械臂孔序规划

摘要/Abstract

摘要： 根据隧道炮孔设计，进行孔序规划，是对凿岩机械臂进行自动控制所需要解决的一个问题。针对这一问题，以机械臂末端杆件的螺旋运动来定义其运动轨迹，用螺旋运动轨迹的曲线长度来定义机械臂将末端执行器从一个孔位运送到另一个孔位所付出的代价，以此代价为基础建立目标函数，用蚁群算法进行问题求解，得到机械臂运动的孔序规划。利用对偶四元数法推导了机械臂末端杆件螺旋运动参数的计算公式。仿真验证了轨迹求解算法，得到的轨迹平滑、连续；针对某隧道断面64组炮孔设计，利用蚁群算法进行左右两个机械臂的孔序规划仿真，得到了合理的规划结果。

关键词: 孔序规划, 螺旋运动, 对偶四元数, 蚁群算法, 螺旋线性插值, 凿岩机械臂

Abstract: One of the problems in the development of computerized tunneling rig is to make a drilling sequence according to a drill pattern design, which is the focus of this work. ACO algorithm was used to get a satisfactory sequence for a drill pattern,where the objective function was based on the trajectory length of screw motion of the end effector transported from one hole position to the next by the manipulator. The formulas were derived for the calculation of the screw motion parameters of the end effector with dual quaternion expressions. Simulations verify the algorithm of screw motion of the interpolation of the trajectory and the trajectory calculated is smooth and continuous. It turns out to be a practical drilling sequence resulting from the ACO algorithm for a prescribed drill pattern with two manipulators (right and left) of a 64-hole tunneling design.

Key words: drilling sequence, screw motion, dual quaternion, ant colony optimization(ACO) algorithm, screw linear interpolation, tunneling rig manipulator

中图分类号:

TP24

王恒升, 陈伟锋, 王思远. 基于末端杆件螺旋运动的凿岩机械臂孔序规划[J]. 中国机械工程.

Wang Hengsheng, Chen Weifeng, Wang Siyuan. Drilling Sequence Planning Based on Screw Motion of End Lever of a Tunneling Rig Manipulator[J]. China Mechanical Engineering.

参考文献

[1]Kukkonen J.The Art of Drill Plan Design[C]// Proceedings of World Tunnel Congress 2008-Underground Facilities for Better Environment and Safety.Agra,2008:1017-1023.

[2]Andersson K.Simulation of a Tunnel Drilling Sequence to Determine Loads on a Rock Drilling Equipment[C]//ADAMS User Conference.Rome, 2000:1-11.

[3]周友行, 何清华,谢习华.基于遗传算法的凿岩机器人孔序规划[J].机器人,2002,24(1): 62-65.

Zhou Youxing, He Qinghua, Xie Xihua. Application of Genetic Alogorithm to Bore Planning of the Tunnel Drilling Robot[J].Robot,2002,24(1): 62-65.

[4]周友行, 何清华.双臂凿岩机器人离散任务规划[J]. 中国机械工程, 2006, 17(13): 1334-1337.

Zhou Youxing, He Qinghua. Discrete Task Planning of Drilling Robot with Two Booms[J].China Mechanical Engnieering,2006,17(13):1334-1337.

[5]Woeginger G J.Exact Algorithms for NP-hard Problems:a Survey[M].Berlin:Springer Berlin Heidelberg, 2003.

[6]Applegate D L.The Traveling Salesman Problem: a Computational Study[M].Princeton:Princeton University Press, 2006.

[7]武元新.对偶四元数导航算法与非线性高斯滤波研究[D].长沙:国防科学技术大学, 2005.

[8]Brand M, Masuda M, Wehner N, et al. Ant Colony Optimization Algorithm for Robot Path Planning[C]//International Conference on Computer Design and Applications.Qinhuangdao,2010:436-440.

[9]Dorigo M, Gambardella L M. Ant Colony System: a Cooperative Learning Approach to the Traveling Salesman Problem[J].IEEE Transactions on Evolutionary Computation,1997,1(1): 53-66.

[10]Sariyildiz E, Temeltas H. A New Formulation Method for Solving Kinematic Problems of Multiarm Robot Systems Using Quaternion Algebra in the Screw Theory Framework[J].Turkish Journal of Electrical Engineering & Computer Sciences, 2012,20(4):607-628.

[11]Shoemake K. Animating Rotation with Quaternion Curves[J].ACM SIGGRAPH Computer Graphics. ACM, 1985, 19(3): 245-254.

[12]Kavan L, Collins S, ára J, et al.Geometric Skinning with Approximate Dual Quaternion Blending[J]. ACM Transactions on Graphics,2010,27(4): 995-999.

[13]Bianchi L, Dorigo M, Gambardella L M, et al. A Survey on Metaheuristics for Stochastic Combinatorial Optimization[J]. Natural Computing an International Journal, 2009, 8(2): 239-287.

[14]李士勇.蚁群算法及其应用[M].哈尔滨：哈尔滨工业大学出版社,2004.

[1]	辜勇, 袁源乙, 张列, 段晶晶. 带时间窗的多中心半开放式车辆路径问题[J]. 中国机械工程, 2020, 31(14): 1733-1740.
[2]	乔东平, 裴杰, 文笑雨, 肖艳秋, 焦建强, . [车间调度]一种求解单机总加权延迟调度问题的改进蚁群算法[J]. 中国机械工程, 2018, 29(22): 2703-2710.
[3]	侯仰强1;王天琪1;李亮玉1;张志臣1;赵娜2. 基于蚁群算法-粒子群算法的白车身侧围点焊机器人路径规划[J]. 中国机械工程, 2017, 28(24): 2990-2994.
[4]	张铁, 苏杰汶. 基于改进蚁群算法的机器人末端路径排序优化[J]. 中国机械工程, 2016, 27(19): 2624-2629.
[5]	方清华, 倪丽萍, 李一鸣. 求解物流Web服务组合问题的两阶段多目标蚁群算法[J]. 中国机械工程, 2016, 27(10): 1327-1336.
[6]	黄风立, 顾金梅, 张礼兵, 徐春光, 王海燕. 基于禁忌制造特征动态调整的STEP-NC工艺路线蚁群优化方法[J]. 中国机械工程, 2016, 27(05): 596-602.
[7]	吴长友, 戴宁, 刘浩, 程筱胜, 李大伟, 沈振宏, 孙登广. 基于改进蚁群算法的分形刀轨连接技术[J]. 中国机械工程, 2016, 27(01): 58-65.
[8]	谢志江, 梁欢, 宋代平. 基于连续蚁群算法的3-RPS并联机构正解[J]. 中国机械工程, 2015, 26(6): 799-803.
[9]	姜康, 胡龙. 复杂环境下的装配路径求解与优化[J]. 中国机械工程, 2015, 26(5): 632-636.
[10]	谢伟松, 邓铮, 丁伯慧 . 用GAAA优化多阶段装配过程中的夹具布局[J]. 中国机械工程, 2015, 26(5): 658-663.
[11]	刘琼, 刘秀城, 张超勇, 饶运清. 基于改进蚁群算法的带时间窗废品收集车辆路径问题[J]. 中国机械工程, 2015, 26(2): 247-244.
[12]	钱立军, 邱利宏, 陈朋. 基于模糊PID扭矩识别的混合动力汽车优化控制[J]. 中国机械工程, 2015, 26(13): 1752-1759.
[13]	汤洪涛, 刘璐, 陈明, 鲁建厦. 基于Stigmergy的Holonic控制架构与调度策略[J]. 中国机械工程, 2015, 26(1): 49-54,62.
[14]	朱兴涛1;张则强1;朱勋梦2;胡俊逸3. 求解多目标拆卸线平衡问题的一种蚁群算法[J]. 中国机械工程, 2014, 25(8): 1075-1079.
[15]	张根保;范秀君. 基于蚁群算法优化选取阈值的EMD消噪方法[J]. 中国机械工程, 2014, 25(4): 427-432.