【技术实现步骤摘要】
一种实时获取凿岩台车双三角钻臂空间位置姿态的方法
本专利技术涉及电脑凿岩台车钻臂的定位技术，具体涉及一种实时获取凿岩台车双三角钻臂空间位置姿态的方法。
技术介绍
隧道及矿山开采过程中，普遍使用全液压凿岩台车钻孔，其钻孔位置的准确定位是整个凿岩钻孔施工的关键。通过机手在操作台操纵钻臂的运动，实现孔眼的定位。但凿岩钻机工作环境复杂，隧道内灰尘，水汽较多，且机手离断面较远，用这种方法孔眼定位不准确，效率低，偏差较大，从而严重影响了爆破效果。为了解决人工定位的不足，电脑凿岩台车以其能够实时获取钻臂三位空间坐标及姿态，实现精准的辅助定位、对孔，逐渐取代传统的全液压凿岩台车，迅速成为隧道施工的主流机械设备。采用双三角钻臂的结构形式，其优点是在空间中平行移动，动作迅速，结构紧凑，平稳性比较好，但是不容易控制，而定位精度是影响钻臂作业的重要因素，因此，如何使钻臂的运动轨迹实现精确控制，对于钻臂末端-纤杆能否精确定位钻孔将产生非常直接的影响。
技术实现思路
本专利技术的目的在于提供一种实时获取凿岩台车双三角钻臂空间位置姿态...
【技术保护点】
1.一种实时获取凿岩台车双三角钻臂空间位置姿态的方法，其特征在于：该方法通过建立双三角钻臂的三维模型，继而建立虚拟样机，对双三角钻臂进行运动学仿真；根据CFDH方法建立双三角钻臂的运动学方程，利用虚拟样机的仿真结果与运动学方程进行比较，以验证运动学方程的正确性，从而获取钻臂双三角钻臂的任意时刻的准确位置姿态；其步骤如下：/n步骤1，获取验证点p
【技术特征摘要】
1.一种实时获取凿岩台车双三角钻臂空间位置姿态的方法，其特征在于：该方法通过建立双三角钻臂的三维模型，继而建立虚拟样机，对双三角钻臂进行运动学仿真；根据CFDH方法建立双三角钻臂的运动学方程，利用虚拟样机的仿真结果与运动学方程进行比较，以验证运动学方程的正确性，从而获取钻臂双三角钻臂的任意时刻的准确位置姿态；其步骤如下：
步骤1，获取验证点pi相对于车架坐标系{0}的三维空间测量坐标0pi_C；
步骤2，基于改进CFDH法，建立双三角钻臂i＝1坐标系；
步骤3，建立相邻关节坐标系的齐次坐标变换矩阵；
步骤4，获取验证点pi的三维空间计算坐标。
2.根据权利要求1中所述的一种实时获取凿岩台车双三角钻臂空间位置姿态的方法，其特征在于：在步骤1中，获取验证点pi相对于车架坐标系{0}三维空间测量坐标0pi_C的具体方法为：
步骤1.1，建立双三角钻臂的三维实体模型，导入到软件中建立虚拟样机；
步骤1.2，布置角度、长度传感器：双三角钻臂设有11个关节，其中8个为转动关节，3个为移动关节，分别在这11个关节上安装角度传感器和长度传感器；
步骤1.3，在虚拟样机中获取点pi空间位置坐标；其步骤为：
①在虚拟样机中，将步骤1.2中传感器的角度、位移
θ1,θ2,θ3,θ4,d5,θ6,θ7,θ8,θ9,d10,d11设定为任意一合理范围内的取值，将虚拟样机模型驱动到传感器设定值；
②取点p1c,p2c,p3c,p4c,p5c,p6c,p7c,p8c,p9c,p10c,p11c分别为关节连杆1-11上任意一点，在虚拟样机中可以测得以上各点的三维空间测量坐标，得到pic＝{xi_c,yi_c,zi_c}。
3.根据权利要求1中所述的一种实时获取凿岩台车双三角钻臂空间位置姿态的方法，其特征在于：在步骤2中，建立钻臂i＝1坐标系的具体方法为：
步骤2.1，找出关节轴i和i+1之间的公垂线或关节轴i和i+1的交点，以关节轴i和i+1的交点作为钻臂坐标系{i}的原点Oi；
步骤2.2，规定沿关节轴i的指向Zi；
步骤2.3，规定从轴i到i+1公垂线，如果关节轴i和i+1相交，则规定Xi轴垂直于关节轴i和i+1所在的平面,确定Xi；
步骤2.4，按照右手定则确定Yi；
步骤2.5，重复步骤...
【专利技术属性】
技术研发人员：贾体锋，牛可，赵建东，王伟，周忠尚，牛勇，张小强，程猛，
申请(专利权)人：徐州徐工铁路装备有限公司，
类型：发明
国别省市：江苏;32
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。