基于位姿误差补偿的全电脑凿岩台车钎杆定位算法

摘要

针对全电脑凿岩台车钻炮孔时钎杆的定位精度要求,从钎杆末端位姿误差补偿角度出发,以DH运动学模型为基础,计算臂架的动态误差和静态误差,建立钎杆定位误差补偿运动学模型;采用多种群遗传算法(MPGA),根据无误差正向运动学逆解所得关节变量(角度和距离)优化各关节值的搜索范围,结合移民算子和人工选择算子进行并行计算,建立基于钎杆运动学误差补偿模型和MPGA求逆解确定关节变量的钎杆定位算法.研究结果表明:基于误差补偿模型进行钎杆定位时,实测钎杆定位误差小于0.1 m,满足工程实际定位要求.