论文部分内容阅读
高性能的机械手在面向物料搬运、IC封装等领域具有无可比拟的优势。机械手的伺服控制系统是机械手系统的核心,伺服系统控制算法的好坏直接影响着机器人系统控制性能的提升,传统的PID控制在机械手高性能的控制方面有一定的局限性。本文针对两自由度(2DOF)机械手进行基于动力学模型的控制算法的研究,并在此基础上进行了控制算法和整个控制系统的仿真分析,完成了实验系统的搭建、控制系统软件编程以及实验验证。首先,论文对机械手本体进行运动学建模与分析,采用Lagrange法对机械手本体进行动力学建模,并建立了减速器和交流永磁同步电机的数学模型。其次,在机械手本体动力学建模的基础之上,对几种基于动力学模型的控制算法进行分析比较。提出了一种新的控制结构,这种控制结构将基于刚体动力学模型的控制算法应用到考虑电机和减速器模型的机电耦合控制系统中去。在此基础之上,进行了计算力矩算法和滑模自适应控制算法的Matlab/Simulink仿真以及与ADAMS的联合仿真,并将两种控制算法进行了机电耦合控制系统的仿真,以验证控制算法和机电耦合控制系统算法结构的可行性。为实际实验系统的实现和调试提供了理论依据。完成了控制系统平台的搭建,该平台采用德州仪器公司(TI)的DSPTMS320F 28335完成控制算法的计算和位置环的调节,由驱动器完成速度环和电流环的运算。编写了DSP实时控制程序,程序采用模块化的编程思想,由C语言和汇编语言混合编程的方法实现。最后进行了实验研究。试验结果表明,在高速时,引入基于动力学模型的控制算法以后,机械手关节的位置和速度跟踪效果有一定的提升。