单片机在倒立摆控制系统的应用

倒立摆作为一种典型的控制系统实验装置，具有非线性、自然不稳定等特性，常用来作为检验某种控制理论或方法是否合理的典型方案。一阶倒立摆系统能用多种理论和方法来实现其稳定控制，如ＰＩＤ、自适应、状态反馈、模糊控制及人工神经元网络等多种理论和方法都能在倒立摆系统控制上得到实现。

　　１系统构成及工作原理

　　图１为一阶旋转倒立摆结构示意图。直流电机作为唯一的动力装置，与旋臂保持刚性连接，带动旋臂在水平面内旋转，旋臂的一端通过转轴（本系统选用电位器角度传感器）与摆杆连接，摆杆可做垂直于旋臂的圆周运动。在自然状态下，摆杆为竖直下垂状态。倒立摆控制的目的是通过控制直流电动机的运动状态，使摆杆保持倒立状态。

　　图１倒立摆结构示意图

　　系统工作原理如下：摆杆摆动时，角度传感器检测摆杆的角度，根据角度传感器的输出特性，其输出电压经Ａ／Ｄ转换器转换成电压数字量，该数字量与期望的值进行比较产生偏差，通过单片机对该偏差进行处理，即ＰＩＤ控制运算，根据运算结果产生控制信号控制电机和旋臂的转动，使摆杆的角度与期望的角度更接近。

　　倒立摆控制系统结构框图如图２所示，单片机（５１单片机）为控制器，直流电机为执行器，倒立摆为被控对象，倒立摆角度为被控量，角度传感器和模数转换器构成反馈回路。

　　图２倒立摆控制系统结构框图

　　２倒立摆控制系统的硬件设计

　　２．１单片机最小系统

　　该系统中选用了ＳＴＣ９０Ｃ５１单片机，该型单片机

　　具有以下特点：①八位ＭＣＵ核，与传统８０５１兼容；②大容量存储空间，包括６４ｋＢ程序空间，１２８０Ｂ

　　ＳＲＡＭ等；③具有４个八位并行Ｉ／Ｏ口，３个定时／计数器，２个外部中断源和１个全双工ＵＡＲＴ传输口；④５Ｖ供电时，最高支持８０ＭＨｚ振荡频率，具备高速浮点运算能力，适合倒立摆系统等较为复杂的控制系统使用。５１单片机最小系统如图３所示。

图3 51单片机最小系统

　　２．２摆杆角度检测

　　检测摆杆角度所用到的角度传感器种类非常多，常用的有电位器式角度传感器、光电编码器、陀螺仪模块等。由于电位器式角度传感器原理简单，检测精度取决于所用Ａ／Ｄ转换器的精度，成本相对较低，因此，综合多方面要求，本系统选用电位器式角度传感器。

　　传感器返回的电压信号无法被单片机直接识别，所以需要通过Ａ／Ｄ转换，将模拟电压信号转换为二进制数的形式，然后单片机才能计算出偏差，进而产生相应的输出。Ａ／Ｄ转换器常用的有８位和１２位输出，在本系统中选用８位Ａ／Ｄ转换器即可满足控制要求，其型号选用ＡＤＣ0809，相应电路原理图见图４。

图4 Ａ／Ｄ转换电路

　　Ａ／Ｄ转换器的时钟脉冲为单片机ＡＬＥ引脚输出的脉冲经７４ＬＳ７４芯片分频之后得到，Ａ／Ｄ转换器的８位数字信号通过单片机的Ｐ０口进行采集与处理。

　　２．３驱动电路

　　本系统选用的直流电机额定电压为２４Ｖ，额定功率为３０Ｗ，单片机的Ｉ／Ｏ口不足以提供如此大的驱动能力，故需采用驱动电路。常用的直流电机驱动芯片为Ｌ２９８Ｎ，可驱动两路直流电机，最大驱动电压为４６Ｖ，最大电流２Ａ～３Ａ，满足设计要求。直流电机驱动电路如图５所示。

图５　直流电机驱动电路

　　图５中，Ｌ２９８Ｎ的ＥＮＡ为使能端，可作为单片机ＰＷＭ（脉宽调制）控制端，控制直流电机转速；ＩＮ１和ＩＮ２为信号输入端，ＯＵＴ１和ＯＵＴ２为输出端，输出

　　状态与输入状态对应，控制直流电机转向。输出端的二极管为续流二极管，起保护电动机线圈的作用。

　　３倒立摆控制系统的软件设计

　　３．１控制算法

　　本系统采用ＰＩＤ控制算法，ＰＩＤ算法适用于负荷变化大、容量滞后较大、控制品质要求高的控制系统。ＰＩＤ算法有３个可设定参数，即比例放大系数ＫＰ、积分时间常数ＴＩ、微分时间常数ＴＤ。比例调节的作用是使调节过程趋于稳定，但会产生稳态误差；积分作用可消除被调量的稳态误差，但由于积分饱和等原因可能会使系统振荡甚至使系统不稳定；微分作用能有效地减小动态偏差［４］。其传递函数为：w w w . d z i u u . c o m

搜索

热门标签

单片机在倒立摆控制系统的应用