基于stm32的单级旋转倒立摆控制系统的设计与实

《基于stm32的单级旋转倒立摆控制系统的设计与实》由会员上传分享，免费在线阅读，更多相关内容在学术论文-天天文库。

1、基于stm32的单级旋转倒立摆控制系统的设计与实现摘要本文对单级旋转倒立摆的控制系统进行了研究，提出了以STM32F103为核心的控制器设计，在控制策略上采用经典控制理论PID的控制算法，实现对单级旋转倒立摆旋转臂及摆杆的同时闭环控制，通过传感器采集摆杆的状态数据，实时调整直流电机的转向和转速，以调整摆臂的角度，使摆杆恢复到动态平衡状态。在非平衡状态下，通过传感器的实时检测，能够通过功能键设计，使摆杆能稳定到一定的角度。最终测试结果表明系统控制策略有效。关键词：STM32F103；直流减速电机；增量式PID1引言　　倒立摆控

2、制系统是自动控制理论的重要研究平台，可对应于火箭垂直发射控制技术，因此对它的研究具有重大的实践意义和价值。目前对倒立摆的研究主要分为系统力学分析及建模，控制算法及仿真，而对实现手段少有研究。文章讨论了以STM32为核心的倒立摆控制器的设计与实现，它实现了经典双回路PID控制算法对旋转单级倒立摆的控制策略。2方案设计与论证2.1总体方案描述整个系统分为系统模块、编码器模块、电机驱动模块、电机模块、电源模块、键盘模块、显示模块。各模块的系统框图如图1.1所示。编码器模块键盘模块电机模块电机驱动模块显示模块电源模块控制模块图1.1

3、系统框图2.2方案比较与选择2.2.1芯片控制模块方案一：采用传统的51系列单片机。传统的51单片机为8位机，价格便宜，控制简单，但是运算速度慢，片内资源少，存储容量小，难以存储大体积的程序和实现快速精准的反应控制。并且受时钟限制，计时精度不高，外围电路也增加了系统的不可靠性。方案二:采用stm32f103单片机stm32f103单片机，具有功能强大、效率高的指令系统，以及高性能模拟技术及丰富的外围模块。方便高效的开发环境使操作更加简便，低功耗是其它类单片机难以比拟的，集成度较高，编程相对简单。综上，选择了性能跟好的stm3

4、2f103单片机。2.2.2电机选择方案一：普通直流伺服电机普通直流伺服电机有价格低使用简单等优点，但其扭矩较小，可控性差，此系统要求控制精度高速度快，直流电机则不能满足要求。方案二：减速电机减速电机克服了普通直流电机扭矩小的缺点，而且价格较低，但其可控性不太好，难以精确控制，但这足以完成任务。方案三：步进电机步进电机具有转角精确可控的优点，速度和转角都能控制，适用于精确控制系统。只是价格稍高。为保证稳定可靠，选用方案二。2.2.3电动机驱动调速模块方案一采用芯片L298驱动电机，用单片机控制L298的输入使之工作在占空比可

5、调的开关状态，精确调整电动机转速。电子开关的速度很快，稳定性也极强。但驱动电流小，无法驱动更大功率的电机，限制了其应用范围。方案二：采用自搭接的H桥电路选用大功率达林顿管或场效应管自制H桥电路，电路原理简单，具有高效，低功率等特点，但是性能不够稳定，电路调试复杂。方案三：采用ACS606数字交流伺服驱动器ACS606全数字交流伺服驱动器采用了最新32位伺服DSP和先进的控制算法。其体积小巧、安装方便、高性价比、高可靠性、调试简单。L298N更符合本系统需求，所以选择方案一。2.2.4编码器选择方案一：增量型编码器增量型编码器

6、存在零点累计误差，抗抖动性差，判断转向困难，断电数据丢失，耗大量单片机资源等缺点。方案二：绝对式编码器绝对式编码器分辨率高、抗扰性好、体积小巧、重量轻、抗抖动性好、节省更多处理器资源。此外，绝对式编码器在断电期间也能准确检测旋转角度偏移量。综合以上两种方案选择，本系统选择HN3806A5V1024绝对值编码器。2.2.5显示方案选择方案一：电压和电流的显示可以用数码管，但数码管的只能显示简单的数字，其电路复杂，占用资源较多，显示信息少，不宜显示大量信息。方案二：采用oled液晶显示器显示采用屏幕液晶显示器oled进行显示，功

7、耗低，分辨率高，抗干扰性能力强，可视面积大。此外oeld与单片机可直接连接，电路设计及连接简单。综上分析，选择方案二。3程序结构设计3.1整体框架是否过设定角度是否否否否否否否是是是是是是否圆周运动初始化液晶开始设定起摆圆周运动手动起摆模式设定角度显示所用时间快速起摆是否倒立PID调节PID调节PID调节PID调节是否倒立开始计时开始计时是否5s是否10s是否设定圆周圆周运动PID调节是是否圆周运动调用键盘程序（1）当系统上电后，LCD与LED点阵屏分别显示各自的开机界面，与此同时stm32f103对按键检测，选择工作状态，

8、设定起摆，圆周运动，手动起摆，快速起摆。通过PID调节实现相应的功能。（2）编码器检测到信号后，调用PID子程序进行计算，PID调节子程序流程图如图4.3所示。图3.6PID流程图（3）键盘初始化，判断是否有按键按下，无键按下，重新进行键盘扫描；有键按下，判断是哪个键按下，并进行相应的操作