论文部分内容阅读
针对多臂凿岩机器人在隧道工作中易发生碰撞事故的问题,提出了一种多臂凿岩机器人的碰撞检测算法.该算法通过对机器人各机械臂间、钻臂与隧道间的实时距离进行计算和碰撞判别,实现凿岩机器人的碰撞检测.以空间圆柱体包络盒作为凿岩机器人各机械臂的碰撞检测模型,将凿岩机器人各机械臂间的碰撞检测问题转化为空间圆柱体包络盒距离求解问题,提出了一种空间两圆柱体碰撞判别方法.将钻臂与隧道轮廓的碰撞问题转化为钻臂在隧道壁面的投影矩形与隧道壁面的干涉问题,提出了一种钻臂与隧道轮廓的碰撞判别方法.最后在MATLAB软件和实际多臂凿岩机器人上进行实验,实验结果表明:该算法能实时检测凿岩机器人各机械臂间、钻臂和隧道间的碰撞情况,在钻臂进入非安全范围时及时给出碰撞信号,使系统及时预警从而避免碰撞干涉事故的发生.