多臂凿岩机器人的碰撞检测方法研究

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

基于改进RRT^*算法的机械臂路径规划研究

针对机械臂避障的难题,采用圆柱体包络法进行碰撞检测和RRT~*的改进算法进行路径搜索,规划出一条能够避免与已知障碍物碰撞,并且路径长度和规划时间较为优化的路径。RRT~*在原有RRT(快速随机树)基础上改进了父节点选择的方式,加入代价函数保证解的渐进最优性。在RRT~*基础上引入目标引力,减少路径搜索的随机性。同时,提出自适应步长避免陷入局部最优。在MATLAB平台上进行了RRT~*、RRT-connect及改进的RRT~*搜索算法的比较研究。结果表明,改进后的RRT~*算法在规划时间上和RRT-connect相近,在规划路径的长度上和RRT~*相近,同时具备时间和路径上的优势。以某品牌型号为WY700-1的机械臂进行了实验验证,结果表明,改进后的RRT~*搜索算法具备有效性和优越性。