论文部分内容阅读
随着电子技术、自动化控制和计算机应用的发展,台式机器人的运动控制不断向着高精度、高速度、微型化、智能化和通用化方向发展。目前,以数字信号处理器(DSP)和现场可编程逻辑门阵列(FPGA)为核心的运动控制方案己成为运动控制方案的发展趋势。它结合了DSP强大的数据计算能力和FPGA的逻辑运算能力,具有数据处理能力强、可扩展能力强、通用性好、运动控制性能强的特点。本文在分析对比基于不同硬件平台、不同算法设计方案的台式机器人运动控制系统的基础上,确定了基于异构多核的算法设计方案。针对异构多核的结构特点,分析并给出了台式机器人运动控制算法任务的分配策略。重点研究了包括插补算法、位置控制算法和速度规划算法在内的台式机器人运动控制核心算法以及在实现过程中的关键技术点。在插补算法方面,采用DSP+FPGA两级插补,DSP实现软件粗插补,FPGA实现硬件精插补,充分发挥软硬件性能,提高插补效率;设计和实现了平面及空间的直线插补及圆弧插补;采用极坐标系、以步距角为进给量实现圆弧粗插补,简化了圆弧插补的过象限处理。在位置控制算法方面,针对台式机器人在高速度、短行程运动过程中产生的振动和强烈冲击,会对系统造成较强干扰等因素。提出了基于BP神经网络自抗扰控制对台式机器人进行位置伺服控制,提高了位置控制的精度和动态响应特性,且具有较好的抗干扰能力。在速度规划算法方面,针对常用的多项式T形、S形曲线加减速计算量较大,不适合于台式机器人插补运动控制高速计算的要求。提出了基于数字卷积方式的加减速控制,其适合于高速计算的要求,可以避免预测减速点,极大的减少计算负担提高了效率,能够快速实现速度规划,速度曲线平滑。在设计实现过程中,将精插补模块、位置计数模块、I/0信号处理、编码反馈信号处理模块和双端口RAM等功能模块以及基于数字卷积的梯形速度控制算法和S形速度控制算法使用单片FPGA来进行硬件实现。在DSPF28M35中采用C语言分别实现了基于时间分割的粗插补算法、速度数据的计算及位置控制算法。最后基于松下A5系列伺服电机驱动器和伺服电机进行试验。验证了本文设计算法的正确性。所设计的两级插补算法的精度仅与精插补的精度有关;所设计的位置控制算法具有较强的抗干扰能力,运动过程中的位置误差控制在1um以内。