《电力电子与电力传动学科硕士研 究生-中期报告-样稿2013综述》由会员分享，可在线阅读，更多相关《电力电子与电力传动学科硕士研 究生-中期报告-样稿2013综述（22页珍藏版）》请在金锄头文库上搜索。
1、大连理工大学硕士学位论文中期报告姓 名 XXXX 学 号 11S106007 院 （系） 电气工程学院 学 科 电力电子与电力传动 导 师 XXXXX 论 文 题 目 欠驱动TORA系统 运动控制研究 中期报告日期 2013年3月9日 检查组长签字 电气工程学院- 14 -1论文工作是否按开题报告预定的内容及进度安排进行本课题主要研究欠驱动TORA系统在平衡点的稳定控制问题，旨在设计一种快速、有效的控制算法，在欠驱动TORA系统受到扰动力后，控制器能够使TORA系统快速地稳定在平衡点。前期已经完成欠驱动TORA系统的数学建模和模型验证，反步滑模算法的设计，并在SIMULINK环境下对整个控制系
2、统进行了仿真实验；利用Solidworks软件设计了TORA系统的机械本体，制作了运动控制卡并完成了运动控制卡的调试工作。目前正在学习DSP及基于DSP的运动控制卡的使用。后续任务是利用TORA实验平台完成控制算法在实物实验中的实现，并撰写毕业论文。课题工作总体进度安排及完成情况如下表1-1：表1-1 课题进度安排及完成情况时间任务进度2012.72012.8查阅资料，了解课题背景完成2012.82012.9建立系统模型、模型验证完成2012.92012.11算法设计、控制系统仿真完成2012.112013.1制作运动控制卡并进行调试完成2013.22013.5完成系统的软硬件设计，进行实物实
3、验。正在进行2013.52013.6撰写毕业论文，准备答辩。未完成总体来看，论文工作与预期安排基本一致，可以按时完成课题任务。2目前已完成的研究工作及结果2.1数学建模如图2-1所示，TORA系统由驱动的小球和一个弹簧连接的小车组成，其中质量为M的小车与弹性系数为k的弹簧相连并在水平面内作一维运动，小车的位置记为x，质量为m的小球在输入转矩为N作用下在水平平面内转动，转动半径为r，小球关于其质心的转动惯量为J，小球逆时针转离规定方向的角度记为。 图2-1 欠驱动TORA系统结构图采用拉格朗日方程对TORA系统进行动力学建模，拉格朗日方程是解决复杂的非自由质点系的动力学问题的基本方法。拉格朗日方
4、程从广义能量出发，以与广义坐标变量数目相等的广义坐标方程来表达系统的动态，其普遍形式是：式中，T为质点系动能，为质点系的广义坐标，k为质点系的自由度数，为广义力。下面对小车和小球进行受力分析，假设水平面光滑，没有外力干扰，系统受到弹力的作用，以弹簧未伸缩时的自由端为原点建立坐标系，x轴与弹簧的伸缩方向相同，y轴与弹簧的伸缩方向垂直，如图2-2所示，小车和小球的坐标分别为和。图2-2 建立坐标系此系统有两个自由度，选x和为广义坐标，则有： (2-1) (2-2)求导得： (2-3) (2-4)小车的动能： (2-5)小球的动能： (2-6)系统的总动能： (2-7)以坐标原点为弹性势能零点，则系
5、统的总势能： (2-8)于是系统的动势为： (2-9)列出如下算式： (2-10)将式(2-10)代入如下拉格朗日方程中： (2-11) 经过计算可得系统的动力学描述： (2-12)将动力学描述写成矩阵形式： (2-13)其中由动力学描述可以看出，TORA系统只有一个施加在小车上的驱动转矩N，但是却有两个状态变量需要控制，分别是小车的位移x和小球的摆角，由于控制输入小于系统的自由度，因此TORA是一个欠驱动机械系统。2.2模型验证为验证以上得出的欠驱动TORA数学模型的正确性，在Matlab/Simulink软件中进行模型验证，如图2-3所示，来检验系统模型能否准确地描述系统的性能和行为。图2
6、-3 TORA系统模型Simulink框图将上述仿真模型进行封装得到系统的模型封装图。如图2-4所示。图2-4 TORA系统模型封装框图仿真结果如图2-5所示：图2-5 TORA系统模型验证结果显然，TORA系统在未加控制输入转矩的情况下，小车和小球的运动情况与图2-5相符，系统呈现出质量弹簧的特征，系统不稳定，在x轴方向持续振荡，小球的转角也随着时间变化。2.3能控性分析对于系统动力学描述的欠驱动TORA系统，设计任务是设计一个控制器，使得系统在任意一个初始位置或在受到扰动的情况下迅速地稳定到平衡点处。本文首先对系统的能控性进行分析，从而为系统设计和控制器设计提供理论依据，在此基础上进行系统
7、的控制器设计。令，可将其写成状态空间形式，则有 (2-14)其中，是状态空间矢量，是状态变量的非线性函数，由TORA的动力学描述可得： (2-15)则：2.3.1可控平衡点为了得到系统的平衡点，我们令，令，由，并将的表达式代入可得：为一个不确定的值因此TORA系统的平衡点为，其中为任意角度，在得到系统的平衡点之后，接下来讨论系统在所有平衡点上是否可控的问题。2.3.2能控性条件可以将系统的状态空间形式转化为以下形式： (2-16)其中A和B的表达式分别为： (2-17) (2-18)其中：TORA系统的能控性矩阵为： (2-19)其中：只要矩阵是满秩的，则系统可控。我们只需要判别是否是满秩来判
8、断能控性矩阵是否满秩，矩阵的行列式为： (2-20)所以是否为0取决于：由此可推出：由此可见，TORA系统的平衡点为：， (2-21)根据以上分析，我们可得出结论，欠驱动TORA系统的可控条件是各参数满足不等式(2-21)。从上面的分析我们可以看出，尽管欠驱动TORA系统需要控制小车的位移x，小球的角度两个自由度的量，但是其仍可通过一个控制输入N来实现对所有状态变量的控制，这是由于系统的驱动量和非驱动量之间存在着非线性耦合，换句话说，对于欠驱动TORA而言，小球的转角和小车的位移x之间存在着非线性耦合，从而使得施加在小球上的控制输入转矩N不仅能够控制小球的转角，也能控制小车的位移x。小球的平衡
9、点不能落在与小车运动方向相同的位置，否则，小球的转角与小车的位移x之间的非线性耦合会消失，控制输入N将不能控制小车在水平方向的位移。2.4控制器设计TORA系统是一个非线性、欠驱动系统，本文在采用拉格朗日方程建模的基础上，结合部分反馈线性化，采用一个闭环坐标变换将系统动力学转换成严格反馈的级联非线性系统，应用反步滑模法实现了系统全局稳定的状态反馈控制器。反步设计方法的思想是将复杂的非线性系统分解成不超过系统阶数的子系统，然后为每个子系统分别设计李雅普诺夫函数和中间虚拟控制量，一直“后退”到整个系统，直到完成整个控制器的设计。带滑动模态的变结构控制叫滑模变结构控制。滑模变结构控制是一种不连续的控
10、制，与其他控制相比，其特殊之处为系统的“结构”不固定，在动态过程中，可以迫使系统运动点沿着预先设定的“滑动模态”的状态轨迹运动。将反步设计方法和滑模设计方法相结合，针对欠驱动TORA系统设计稳定控制器，实际系统的参数变化将通过滑模控制器来补偿，不仅能够实现系统的全局稳定，还可以使系统的鲁棒性提高。2.4.1严格反馈级联规范型将(2-12)TORA的动力学描述通过部分反馈线性化可得： (2-22)其中，将TORA的动力学形式转化为： (2-23)考虑TORA系统，全局坐标变换， (2-24)将TORA系统转换成一个具有严格反馈形势的级联非线性系统，即 (2-25)其中，由此通过计算可得，TORA
11、级联系统可写为： (2-26)2.4.2 基于反步滑模的稳定控制算法通过以下四个步骤来设计欠驱动TORA系统的稳定控制器：Step1：令 (2-27)取李雅普诺夫函数 (2-28)则 (2-29)以上算式可以将系统全局稳定在。Step2：令 (2-30)则 (2-31)取李雅普诺夫函数 (2-32)系统可化为： (2-33)则 (2-34)将式(2-33)代入(2-34)，得： (2-35)令 则有： (2-36)取则有.即 (2-37)令取则 (2-38)所以 即 以上算式可以将系统全局稳定在。Step3：令， (2-39)系统可化为： (2-40)取李雅普诺夫函数 (2-41)经过计算可得： (2-42)而 (2-43)取控制输入 (2-44)则 (2-45)以上算式可以将系统全局稳定在。Step4：令 (2-46) 则
