一阶倒立摆控制系统.doc

一阶直线倒立摆系统 姓名： 班级： 学号： 目录 摘要…………………………………………………………………………3 第一部分 单阶倒立摆系统建模 ………………………………4 （一） 对象模型…………………………………………………………4 （二）电动机、驱动器及机械传动装置的模型 …………………6 第二部分 单阶倒立摆系统分析…………………………………7 第三部分 单阶倒立摆系统控制…………………………………11 （一）内环控制器的设计………………………………………………11 （二） 外环控制器的设计 ……………………………………………14 第四部分 单阶倒立摆系统仿真结果…………………………16 系统的simulink仿真……………………………………………………16 摘要： 该问题源自对于娱乐型”独轮自行车机器人”的控制，实验中对该系统进行系统仿真，通过对该实物模型的理论分析与实物仿真实验研究，有助于实现对独轮自行车机器人的有效控制。 控制理论中把此问题归结为“一阶直线倒立摆控制问题”。另外，诸如机器人行走过程中的平衡控制、火箭发射中的垂直度控制、卫星飞行中的姿态控制、海上钻井平台的稳定控制、飞机安全着陆控制等均涉及到倒立摆的控制问题。 实验中通过检测小车位置与摆杆的摆动角，来适当控制驱动电动机拖动力的大小，控制器由一台工业控制计算机（IPC）完成。实验将借助于“Simulink封装技术——子系统”，在模型验证的基础上，采用双闭环PID控制方案，实现倒立摆位置伺服控制的数字仿真实验。实验过程涉及对系统的建模、对系统的分析以及对系统的控制等步骤，最终得出实验结果。仿真实验结果不仅证明了PID方案对系统平衡控制的有效性，同时也展示了它们的控制品质和特性。 第一部分 单阶倒立摆系统建模 （一） 对象模型 由于此问题为”单一刚性铰链、两自由度动力学问题”，因此，依据经典力学的牛顿定律即可满足要求。 如图1.1所示，设小车的质量为，倒立摆均匀杆的质量为，摆长为，摆的偏角为，小车的位移为，作用在小车上的水平方向上的力为，为摆杆的质心。 图1.1 一阶倒立摆的物理模型 根据刚体绕定轴转动的动力学微分方程，转动惯量与角加速度乘积等于作用于刚体主动力对该轴力矩的代数和，则 摆杆绕其重心的转动方程为 （1-1） 2）摆杆重心的水平运动可描述为 （1-2） 摆杆重心在垂直方向上的运动可描述为 （1-3） 小车水平方向运动可描述为 （1-4） 由式（1-2）和式（1-4）得 （1-5） 由式（1-1）、式（1-2）和式（1-3）得 （1-6） 整理式（1-5）和式（1-6），得 （1-7） 因为摆杆是匀质细杆，所以可求其对于质心的转动惯量。因此设细杆摆长为，单位长度的质量为，取杆上一个微段，其质量为，则此杆对于质心的转动惯量有 杆的质量为 所以此杆对于质心的转动惯量有 由式（2-20）可见，一阶直线倒立摆系统的动力学模型为非线性微分方程组。为了便于应用经典控制理论对该控制系统进行设计，必须将其简化为线性定常的系统模型。 若只考虑在其工作点附近（）的细微变化，则可近似认为 在这一简化思想下，系统精确模型式（1-7）可简化为 若给定一阶直线倒立摆系统的参数为：小车的质量；倒摆振子的质量；倒摆长度；重力加速度取，则可得到进一步的简化模型为 (1-8) 上式为系统的”微分方程模型”，对其进行拉普拉斯变换可得系统的传递函数模型为 （1-9） （二）电动机、驱动器及机械传动装置的模型 假设：选用日本松下电工MSMA021型小惯量交流伺服电动机，其有关参数如下： 驱动电压：U=0100V 额定功率：=200W 额定转速：n=3000r/min 转动惯量： 额定转矩： 最大转矩： 电磁时间常数：=0.001s 电机时间常数：=0.003s 经传动机构变速后输出的拖动力为：F=016N；与其配套的驱动器为：MSDA0