井下搬运机械手插补系统的设计

针对井下物料搬运特点,采用STC15F2K60S2系列单片机作为开发平台,实现了一种低成本搬运机械手的插补控制。通过对插补控制器硬件与软件模块组成和功能的设计,实现了输入脉冲的产生、输出脉冲的计数以及运动方向的控制。根据物料输送轨迹的特点,设计了快速插补准备模块的算法,对等速和加减速阶段进行了参数计算,为基于单片机平台的插补系统研究提供了一定的参考。