针对目前煤矿井下掘进过程自动化程度低、掘进效率低、巷道成型质量差等问题,提出了一种悬臂式掘进机器人巷道成形智能截割控制系统。该系统结合巷道尺寸和截割工艺要求,基于三次多项式光滑函数的悬臂式掘进机器人关节空间轨迹规划方法,通过建立的悬臂式掘进机器人坐标系统及悬臂式掘进机器人运动学正问题与逆问题求解,确定轨迹规划光滑函数参数;规划好截割轨迹后,以视觉定位方法获得的悬臂式掘进机器人截割头位姿数据作为反馈量,基于反馈线性化积分滑模控制器的截割轨迹控制算法实时计算控制量,以规划轨迹点和视觉测量位姿点构建反馈控制系统,实现对悬臂式掘进机器人巷道成形截割过程的动态控制。实验结果表明,该系统能够实现悬臂式掘进机器人巷道成形截割过程的智能控制,定位精度高,稳定性好,轨迹跟踪误差小于25.61mm,可满足巷道成形质量需求。
主办单位:煤炭科学研究总院有限公司 中国煤炭学会学术期刊工作委员会