2013年国赛旋转倒立摆正式论文

I
目录
1 系统结构、方案与设计.................................... 1
1.1 机械结构设计..................................................................................................1 1.2 电控系统结构..................................................................................................1 1.3 控制器模块的论证与选择..............................................................................2 1.4 控制算法的论证与选择..................................................................................2
III
1 系统结构、方案与设计
1.1 机械结构设计
我们使用加重过的底盘，克服电机瞬间加减速时巨大的震动。摆杆使用实心的钢棒， 充足的重量保证了其转动时不太受阻尼的影响而不灵活。与摆杆链接的转轴使用轴承座 与水平臂连接，保证摆杆优良能非常优异，可以对速度等进行精准的控制。电机与水平 臂通过联轴器连接，避免了不同的灵活性。编码器接在转轴的后端，直接测量摆杆的角 度值。电机使用伺服电机，其优异的性能可以得到很好的控制效果。电机与水平臂的连 接采用联轴器，避免了不同轴的问题对电机的伤害。水平臂做成双方向的，在摆杆的反 方向加上配重，用以平衡重力与转矩，使整个系统能够做到静平衡和动平衡。这样，我 们就搭建了一个稳定可靠的机械系统，这是的系统的各项参数处于比较稳定的状态，有 利于后期控制系统的调节。
2 系统理论分析与计算...................................... 3
2.1 环形倒立摆物理模型建立..............................................................................3 2.2 摆杆位置检测..................................................................................................5 2.3 水平臂位置检测..............................................................................................5 2.4 电机及其驱动模块的论证与选择..................................................................5
5 参考文献 .............................................. 11
附录 1 .................................................. 12
附 1.1：电路原理图............................................................................................12 附 1.1.2 单片机最小系统............................................................................12 附 1.1.3 电源模块........................................................................................13 附 1.1.4 电机驱动模块................................................................................13 附 1.1.5 显示模块........................................................................................14
3.2 程序的设计......................................................................................................8 3.2.1 程序功能描述与设计思路...................................................................9 3.2.2 程序流程图（详见附件 1.2）.............................................................9
3 电路与程序设计 ......................................... 7
3.1 电路的设计......................................................................................................7 3.1.1 系统总体框图（模块电路图详见附件 1.1）.....................................8 3.1.2 单片机系统[3] .......................................................................................8 3.1.3 电源电路设计.......................................................................................8 3.1.4 电机驱动电路设计...............................................................................8
4 测试方案与测试结果...................................... 9
4.1 测试方案..........................................................................................................9 4.2 测试条件与仪器............................................................................................. 9 4.3 测试结果及分析..............................................................................................9
附 1.2 程序流程图：...........................................................................................14
II
附录 2：部分源程序 ...................................... 15
4.3.1 测试结果(数据)....................................................................................9 4.3.2 测试分析与结论................................................................................. 11
1.2 电控系统结构
根据题目要求，系统主要实现倒立摆的各项功能，系统框图如图 1.1 所示，可分为
1
电源模块、CPU 最小系统模块、电机驱动模块、编码器模块、显示模块。
电源模块 编码器模块
显示模块
1.1 系统
控制器模块
电机驱动 键盘输入
图 1.1 系统模块框图
1.3 控制器模块的论证与选择
方案一：采用以增强型 80C51 内核的 STC 系列单片机 STC12C5A60S2，其片内集成 了 60KB 程序 Flash，2 通道 PWM、16 位定时器等资源，操作也较为简单，具有在系统 调试功能（ISD），开发环境非常容易搭建。但实际使用了编码器等对速度要求较高的外 设，因此无法很好地符合设计的需要。
2.4.1 电机选型：...........................................................................................5 2.4.2 电机驱动模块：...................................................................................6 2.5 双环 PID 控制算法 ........................................................................................6
方案二： 采用以 ARM Cortex-M4 为内核的 STM32F4 系列控制芯片，STM32 系列 芯片时钟频率高达 168MHz 具有 512K 字节 SRAM，具有极强的处理计算能力。较为适 合需要快速反应的倒立摆系统。
通过比较，我们选择方案二，采用 STM32F4 系列单片机 STM32F407 作为控制器。
2
此我们选择双环 PID 进行控制。
2 系统理论分析与计算