编辑: liubingb | 2018-11-22 |
第二章 单节倒立摆的数学模型 2.1模型的推导原理 系统建模可以分为两种:机理建模和实验建模.实验建模就是通过在研究对象上加上一系列的研究者先确定的输入信号,激励研究对象并通过传感器的检测其可观测的输出,应用数学手段建立起系统输入---输出关系.这里包括输入信号的设计选取,输出信号的精确检测,数学算法的研究等等内容.机理建模就是在了解研究对象在运动规律基础上,通过物理,化学的知识和数学手段建立起的系统内部的输入输出状态关系.系统的建模原则: 1) 建模之前,要全面了解系统的自然特征和运动机理,明确研究目的和准确性要求,选择合适的分析方法. 2) 按照所选分析法,确定相应的数学模型的形式;
3) 根据允许的误差范围,进行准确性考虑,然后建立尽量简化的合理的数学模型. 无法通过测量频率特性方法获取其数学模型.,实验建模存在一定的困难,但经过小心的假设忽略一些次要的因素外,倒立摆系统就是一个典型的运动刚体系统,可以在惯性坐标系内应用经典力学理论基础建立系统的动力学方程. 2.2单级倒立摆系统描述 小车―倒立摆系统是各种控制理论的研究对象.只要一提小车―倒立摆系统,一般均认为其数学模型也已经定型.事实上,小车―倒立摆的数学模型与驱动系统有关,常见到的模型只是对应于直流电机的情况,如果执行机构是交流伺服电机,就不是这个模型了.本文主要分析由直流电机驱动的小车―倒立摆系统.小车倒立摆系统是检验控制方式好坏的一个典型对象,其特点是高阶次、不稳定、非线性、强耦合,只有采取有效的控制方式才能稳定控制. 在忽略空气阻力,各种摩擦之后,可将直线一级倒立摆系统抽象成小车忽然均匀质杆组成的系统,如下图所示: 图中F是施加于小车的水平方向的作用力,x是小车的位移,Φ是摆的倾斜角.若不给小车施加控制力,倒摆会向左或向右倾斜,控制的目的是当倒摆出现偏角时,在水平方向上给小车以作用力,通过小车的水平运动,使倒摆保持在垂直的位置.即控制系统的状态参数,以保持摆的倒立稳定. M 小车的质量 0.5Kg m 摆杆的质量 0.2Kg B 小车的摩擦力 0.1N/m/sec l 摆杆转动轴心到杆之质心的长度 0.3m I 摆杆惯量 0.006kg*m*m F 加在小车上的力 X 小车位置 θ 摆杆与垂直方向向下的夹角 Φ 摆杆与垂直方向向上的夹角 2.3 单节倒立摆的系统数学建模 倒立摆系统最终的控制目的是使倒立摆这样一个不稳定的被控对象,通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统,单节倒立摆系统的控制模型是目前国内外广泛采用的模型是研究各种控制算法的基础. 该系统由计算机,运动控制卡,伺服机构,倒立摆,本体和光电码盘等几部分组成了一个闭环系统.如图所示: 光电码盘将小车的位移速度信号反馈给伺服驱动器和运动控制卡,摆杆的位置,速度信号由光电码盘也反馈回运动控制卡.计算机从运动控制卡中读取实时数据,确定控制决策(小车向哪个方向移动,移动速度!加速度等.)并实现该控制决策,产生相应的控制量,使电机带动小车,保持平衡. 2.3.1 结构参数 倒立摆是不稳定的,如果没有适当的控制力作用在它的上面,它将随时可能向任何方向倾倒.这里只考虑二维问题,即认为倒立摆只在图2所示平面内运动.控制力F作用于小车上.摆杆长度为l,质量为m,小车的质量为M,小车瞬时位移为x,摆杆瞬时位置为(x+2L*sinΦ),在外力的作用下,系统产生运动.假设摆杆的重心位于其几何中心.设输入为作用力F,输出为摆角Φ. 2.3.2系统的运动方程 控制要求:在摆受到外力F时,调节小车的位置x,保持摆杆平衡. 应用牛顿力学可推导出该倒立摆系统的运动学方程 注意:此方程中力矩的方向,由于θ= π +Φ, ,,