球杆控制系统设计与仿真.docVIP

继教学院 X 禹志控制系统实践大作业球杆控制系统设计与仿真学号：X名：禹志球杆控制系统设计与仿真一 球杆系统的数学模型球杆系统的物理模型如下图所示：图1：球杆系统模型 在这个模型里，我们假设球在杆上只有纯滚动而没有滑动并且我们忽略球和杆之间的摩擦力。我们定义这个模型中的变量和常量如下： m 球的质量0.1 kgR 球的半径0.02d 轮的半径0.05g 重力加速度 9.8 m/s^2 L 杆长1.0 m J 球的转动惯量 1.0e-5 kgm^2 r 球的位置 杆与水平的夹角 伺服机构与水平的夹角 表1：模型的变量和常量球杆系统的数学建模：系统的动能：系统的势能：该系统的拉格朗日方程为：通过拉格朗日法得到球的运动方程：若我们假设杆与水平的夹角是小角度且，对上面的方程进行线性化，我们得到：杆的角度与伺服机构的角度的关系可以近似的线性化为：综合上面几个方程我们得到：对方程两边做拉普拉斯变换：整理后我们得到系统线性化后的开环传递函数：二 控制器的设计在这里，我们采用普遍使用的PID控制器。整个系统的闭环框图可以表达为：图2：线性化后的控制框图令 ，得：我们取=21，=0，=14，将球稳定在杆的中点，仿真结果如下图所示：图3：仿真结果 通过仿真结果表明将系统线性化后，该系统的超调量小于1%，上升时间3秒。如果我们