基于内模的scara机器人轨迹跟踪控制方法
【专利摘要】本发明提供了一种基于内模的SCARA机器人轨迹跟踪控制方法。不需要知道被控对象精确的数学模型，具有强鲁棒性、高跟踪精度、快速跟踪速度，并且控制结构简单，参数调节单一。为使系统的稳态误差为零，需要在控制回路中添加滤波器f，滤波器中的参数λ是整个系统的调节参数，可以调节系统的响应时间和控制精度，参数调整简单明了，系统性能优越。
【专利说明】基于内模的SCARA机器人轨迹跟踪控制方法
【技术领域】
[0001]本发明涉及SCARA机器人轨迹跟踪控制领域，具体是指为了使SCARA机器人在外界干扰大的情况下具有优良的轨迹跟踪性能，提出一种用内模控制原理设计机器人控制器的方法。此方法结构简单，控制性能优越，可以在时变信号和外界干扰的情况下保持稳态误
差为零。
【背景技术】
[0002]机器人技术集机械、电子、计算机、自动控制、人工智能等基础和高新学科领域的理论和技术于一体，机器人本体的设计需要考虑材料选择、质量分配、尺寸优化等问题，需要应用三维造型、有限元分析、运动学和动力学分析、最优化理论等手段。机器人的控制系统涉及到伺服驱动、运动控制、计算机软件等。机器人的人机交互系统需要采用高性能嵌入式系统，需要考虑安全性和易操作性。
[0003]SCARA机器人系统是一个复杂的多输入多输出的非线性系统，具有时变、强耦合和非线性的动力学特性。轨迹跟踪控制是工业机器人控制中的一个重要内容。机器人轨迹跟踪控制是指通过给定各关节的驱动力矩，使机器人的位置、速度等状态变量跟踪给定的理想轨迹，对于整个轨迹来说，都需要严格控制。因此，轨迹跟踪控制是十分复杂与困难，但也是工业生产中应用最为广泛的控制方式。研究机器人轨迹跟踪控制以及提高轨迹跟踪控制的精度对机器人技术有着重要的意义。
[0004]对于自由运动的SCARA机器人来说，其控制器设计可以按是否考虑机器人的动力学特性而分为两类:(I)完全不考虑机器人的动力学特性，只是按照机器人实际轨迹与期望轨迹间的偏差进行负反馈控制。这类方法通常被称为运动控制。主要优点是控制律简单，易于实现。但对于控制高速高精度机器人来说，这类方法有两个明显的缺点:一是难于保证受控机器人具有良好的动态和静态品质，二是需要较大的控制能量。(2)考虑动力学的控制器设计方法，根据机器人动力学模型的性质设计出精细的非线性控制律。这类控制通常称为动态控制。用这种方法设计的控制器可使被控机器人具有良好的动态和静态品质，克服了运动控制方法的缺点。
[0005]虽然一些智能控制算法能达到高精度控制要求，但控制结构复杂，算法计算时间长，有时需要调节多个参数才能到达控制的要求。因此希望能设计一个控制结构简单，调节参数单一，同时满足控制精度的控制器。
【发明内容】
[0006]本发明的目的是针对SCARA机器人在输入信号时变且具有外界干扰的情况下能否满足轨迹跟踪精度且控制器结构设计简单，调节参数单一的问题，设计一种基于内模原理的SCARA机器人控制器设计策略。
[0007]为达此目的，本发明技术方案如下:建立SCARA机器人的动力学模型，根据动力学方程估算各关节的惯性力矩、向心力和哥氏力矩、重力矩，最后得出各关节的力矩估算公式，将其作为内模对对象的估计模型。然后，为确保系统的稳定性和鲁棒性使系统的稳态误差为零，需要设计内模滤波器f，最后通过调整参数λ，使系统达到机器人精度要求。整个流程包括:动力学估算模块、建立内模模型模块、设计内模控制器模块、控制律计算模块。
[0008]第一步，建立SCARA机器人各连杆坐标系，确定各连杆的D-H参数(ai; Qi,
0i)。由拉格朗日函数方程:
【权利要求】
1.本发明提出了一种基于内模的SCARA机器人轨迹跟踪控制方法:它不需要知道被控对象的具体数学模型，具有强鲁棒性；相比传统控制方法提高了跟踪精度，跟踪速度，并且控制结构简单，参数调节单一，本发明首先对SCARA机器人进行动力学模型建模，获得SCARA机器人惯性力矩、向心力和哥氏力矩、重力矩的估计值；将其作为内模对对象的估计模型，然后，为确保系统的稳定性和鲁棒性使系统的稳态误差为零，需要设计内模滤波器f，最后通过调整参数λ，使系统达到机器人精度要求，本发明的设计主要包括以下几个模块: (1)、动力学估算模块:通过建立SCARA机器人动力学方程，根据机器人坐标变换估算各关节的惯性力矩、向心力和哥氏力矩、重力矩的估算值； (2)、建立内模模型模块:根据得到的SCARA机器人动力学数学模型建立内模的估计模型M (S)，M(S)可分为两项眞⑶和1 (S)，即M(S) = M+(S)M_(S)，其中，M+(S)为模型中包含纯滞后和不稳定零点的部分，M_(S)为模型中的最小相位部分； (3)、设计内模控制器模块:为确保系统的稳定性和鲁棒性使系统的稳态误差为零，需在最小相位M_(S)的逆上添加滤波器f，则此时的内模控制器为
2.根据权利要求1所述基于内模的SCARA机器人轨迹跟踪控制方法，其特征是:所述动力学建模模块，估算各个关节的惯性力矩、向心力和哥氏力矩、重力
矩；由拉格朗日方程
3.根据权利要求1所述基于内模的SCARA机器人轨迹跟踪控制方法，其特征是:所述建立内模模型模块，通过计算的内模模型为:
4.根据权利要求1所述基于内模的SCARA机器人轨迹跟踪控制方法，其特征是:设计内模控制器模块，取滤波器为
5.根据权利要求1所述基于内模的SCARA机器人轨迹跟踪控制方法，其特征是:所述控制律计算模块，根据计算可以解得SCARA机器人控制率为:
【文档编号】G05D3/12GK103728988SQ201310732275
【公开日】2014年4月16日 申请日期:2013年12月24日 优先权日:2013年12月24日
【发明者】白瑞林, 赵登步, 许凡, 张涛, 曹沁婕 申请人:江南大学