[发明专利]基于内模的SCARA机器人轨迹跟踪控制方法

说明书

技术领域

本发明涉及SCARA机器人轨迹跟踪控制领域，具体是指为了使SCARA机器人在外界干扰大的情况下具有优良的轨迹跟踪性能，提出一种用内模控制原理设计机器人控制器的方法。此方法结构简单，控制性能优越，可以在时变信号和外界干扰的情况下保持稳态误差为零。

背景技术

机器人技术集机械、电子、计算机、自动控制、人工智能等基础和高新学科领域的理论和技术于一体，机器人本体的设计需要考虑材料选择、质量分配、尺寸优化等问题，需要应用三维造型、有限元分析、运动学和动力学分析、最优化理论等手段。机器人的控制系统涉及到伺服驱动、运动控制、计算机软件等。机器人的人机交互系统需要采用高性能嵌入式系统，需要考虑安全性和易操作性。

SCARA机器人系统是一个复杂的多输入多输出的非线性系统，具有时变、强耦合和非线性的动力学特性。轨迹跟踪控制是工业机器人控制中的一个重要内容。机器人轨迹跟踪控制是指通过给定各关节的驱动力矩，使机器人的位置、速度等状态变量跟踪给定的理想轨迹，对于整个轨迹来说，都需要严格控制。因此，轨迹跟踪控制是十分复杂与困难，但也是工业生产中应用最为广泛的控制方式。研究机器人轨迹跟踪控制以及提高轨迹跟踪控制的精度对机器人技术有着重要的意义。

对于自由运动的SCARA机器人来说，其控制器设计可以按是否考虑机器人的动力学特性而分为两类：(1)完全不考虑机器人的动力学特性，只是按照机器人实际轨迹与期望轨迹间的偏差进行负反馈控制。这类方法通常被称为运动控制。主要优点是控制律简单，易于实现。但对于控制高速高精度机器人来说，这类方法有两个明显的缺点：一是难于保证受控机器人具有良好的动态和静态品质，二是需要较大的控制能量。(2)考虑动力学的控制器设计方法，根据机器人动力学模型的性质设计出精细的非线性控制律。这类控制通常称为动态控制。用这种方法设计的控制器可使被控机器人具有良好的动态和静态品质，克服了运动控制方法的缺点。

虽然一些智能控制算法能达到高精度控制要求，但控制结构复杂，算法计算时间长，有时需要调节多个参数才能到达控制的要求。因此希望能设计一个控制结构简单，调节参数单一，同时满足控制精度的控制器。

发明内容

本发明的目的是针对SCARA机器人在输入信号时变且具有外界干扰的情况下能否满足轨迹跟踪精度且控制器结构设计简单，调节参数单一的问题，设计一种基于内模原理的SCARA机器人控制器设计策略。

为达此目的，本发明技术方案如下：建立SCARA机器人的动力学模型，根据动力学方程估算各关节的惯性力矩、向心力和哥氏力矩、重力矩，最后得出各关节的力矩估算公式，将其作为内模对对象的估计模型。然后，为确保系统的稳定性和鲁棒性使系统的稳态误差为零，需要设计内模滤波器f，最后通过调整参数λ，使系统达到机器人精度要求。整个流程包括：动力学估算模块、建立内模模型模块、设计内模控制器模块、控制律计算模块。

第一步，建立SCARA机器人各连杆坐标系，确定各连杆的D-H参数(a_i，α_i，d_i，θ_i)。由拉格朗日函数方程：i＝1，2，...，n，推导出动力学方程：其中T_i为关节i处的广义力矩，q_i为关节i处的广义位移，n为机器人的连杆数，D_ij表示关节i，j之间的惯量，D_ijk表示关节i处的哥氏力和离心力，D_i表示关节i处的重力载荷。

根据动力学方程计算出惯性力项、哥氏力项和重力项H，C，G。最后得出力矩估算公式：τ=Hq··+Cq·+G.]]>