一种Delta机器人运动机构的模糊PI控制器设计方法

摘要

本发明提供了一种基于LabVIEW图形化编程软件，设计Delta机器人运动机构控制器的方法，用于改善系统的动态响应性能，提高跟踪的精度，属于机器人控制技术领域。首先基于Delta机器人的结构，求解机器人的运动学关系，构建末端执行器到运动各轴的逆运动学方程；利用五次多项式曲线拟合各轴的运动路径；由伺服电机的编码器反馈得到的信息，经FPGA模块处理得到位置偏差e，输入到模糊PI控制器内，控制器输出速度的脉冲信号；通过NI的PCI-7842R板卡上的FPGA模块驱动伺服电机驱动器，从而使电机准确快速地旋转到给定位置。