(1)确定煤矸分拣机器人的基本结构,依据机器人的工作原理和煤矸分拣工作的控制需求,提出煤矸分拣机器人的总体控制方案。(2)研究模糊逻辑推理方法,根据识别区域待抓取矸石特性,构建待抓取优先级排序模型。为了解决拣矸胶带机上矸石的机械臂动态跟踪轨迹规划问题,采用比例导引法,建立机械臂拣矸过程的机械臂运动轨迹规划模型。考虑到大块矸石需要同步跟踪抓取的问题,基于七段式梯形曲线规划机械臂同步跟踪运动轨迹,为保证机械臂运动时间最短,基于遗传算法优化七段式梯形曲线中“匀加速”、“匀速”和“匀减速”阶段机械臂的运动时间,并给出轨迹规划整体流程。(3)建立机器人单关节电机驱动滚珠丝杠系统的数学模型,并以此模型为被控对象,针对控制机械臂跟踪规划好的期望复杂轨迹问题,设计变论域模糊PID控制器,研究详细的设计过程,并在Matlab上对比传统PID控制器进行控制效果的仿真。(4)研究煤矸分拣机器人的控制系统,搭建检测带速模块、控制模块和通信模块等硬件子系统,基于C#在Visual Studio开发环境中开发软件控制系统,采用以太网通信方式,确保上下位机的数据交互。在此基础上,以桁架式双机械臂为机器人本体,搭建煤矸分拣机器人控制系统平台,并进行试验,验证本文提出的控制方法的控制效果及开发的煤矸分拣机器人控制系统的正确性和可靠性。
