构型改进型凿岩机器人钻孔定位方法研究

Study on Posture Determination Method for Holes of Rock Drilling Robots with Improved Architecture

设计了一种改进型凿岩机器人,其腕部为含伸缩构件的偏置结构,肩部为两两相交结构。发现了该机器人的两个特性:一是对第5自由度参数的求解可以转化为对特定直线与特定平面法线之间夹角的求解,二是关节轴3和关节轴4的交点与原点之间的距离为定值。根据上述两个特性,可以采用迭代搜索方法获得第5和第6自由度参数值。提出了一种新的机器人运动学求解方法,其计算过程无须建立各连杆坐标系,采用倒序逐步完成的方法进行正向求解,采用逐步归位的方法进行逆向求解。加工组装了改进型凿岩机器人,编制了计算程序,并完成了工业性试验。试验结果表明:所设计的凿岩机器人操作安全可靠、计算快速准确,解决了旧式凿岩机器人计算耗时长和定位精度不够的难题,可为实现深部煤层无人化采掘提供一定的参考。

An improved rock drilling robot was designed,the wrist was an offset structure with a prismatic link,and the shoulder was the intersecting structure.Two features of the robot were found:one was that the solution for the fifth degree of freedom parameter was equivalent to the solution for the angle between a special line and the normal of a special plane,the other one was that the distance between the intersection point of joint axis 3 and 4 and the origin point was fixed.According to the above two characteristics,the fifth and sixth degree of freedom parameter values might be obtained by iterative search method.A new method for solving robot kinematics was presented,it wasn't necessary to establish the coordinate frames attached to all the links in the calculation processes.The forward solution was carried out in reverse order step by step,and the inverse solution was carried out step by step by returning method.The improved rock drilling robot was machined and assembled,the calculation program was compiled,and the industrial test was completed.The testing results show that the designed rock drilling robot is safe and reliable in operations,fast and accurate in calculations,which solves the problems of long calculation time and insufficient positioning accuracy of the old rock drilling robots,and may provide certain references for the realization of unmanned mining in deep coal seams.