2013年全国大学生电子设计竞赛C题-旋转倒立摆

系统方案

总体设计方案

本系统主要由电位器模块、直流减速电机模块、电源模块、电机驱动模块、单片机最小系统班组成。电位器与主控芯片STM32F407ZGT6相连，通过电位的测算实时向MCU发送摆杆的状态，MCU通过控制LM298N电机驱动模块来控制直流减速电机，进而控制摆杆的状态，并使用LCD显示相关参数。

方案的比较与选择

2.1传感器的选择

方案一：采用三轴陀螺仪测量摆杆的偏转角度。当选用三轴陀螺仪检测摆杆的偏转角度时，虽然可以计算摆杆的偏转角度，但是传感器必须要固定在摆杆上，同时需与MCU直连以进行通信，给硬件的搭建与连接及软件的编写大大增加了难度，可行性较差。

方案二：采用电位器测量摆杆的偏转角度。当选用电位器测量摆杆的偏转角度时，虽然在测量时可能会因电位器的固有误差导致角度换算误差，但当使用较高精度的电位器时便可有效降低此类误差。且其机械结构使其可作为摆杆的转动主轴，故可有效降低硬件部分的复杂性，并增强其稳定性。此外，其较为简单的原理也便于软件的编写，故此方案的可行性较强。

综上所述，选择方案二。

2.2电机的选择

方案一：采用步进电机驱动旋转臂。步进电机具有动态响应快、易于启停、易于正反转的切换及变速的优点。但缺点是它以步进式跟进，角度小于一个步进角时是系统的响应盲区，此外，在实际测试时，步进电机在驱动旋转臂时，抖动较大，且易出现卡顿现象，故其不适合倒立摆的控制。

方案二：采用直流减速电机驱动旋转臂。直流减速电机相较于直流电机虽然转速较低，但扭矩大，且转速足以使用。且其体积小，驱动电路简单，稳定性强，负载能力强，不会出现类似步进电机的卡顿、抖动的现象。

综上所述，选择方案二。

2.3主控芯片的选择

方案一：选用传统的51单片机。当选用51单片机作为控制系统时，可以通过外部AD芯片对传感器发回的模拟量进行检测，并采用PID算法对摆杆的状态进行控制，但由于51单片机的运算速度经过十二分频，且需使用IO口模拟SPI总线协议，这样对单片机的性能有着很高的挑战性，同时还要在此基础上对直流减速电机进行实时操控，可实行性较差，很难实现预期效果。

方案二：选用STM32F407ZGT6单片机。当选用F4单片机作为控制系统时，因其片内自带AD转换、PWM脉宽调制和SPI总线接口。且F4单片机比传统的的51单片机性能强劲许多。

综上所述，选择方案二。

理论分析与参数计算

理论分析

1.1PWM脉冲宽度调制

STM32F407ZGT6单片机内部自带有PWM脉宽调制，通过调节PWM波的占空比，来控制电机的转速，并通过改变电机驱动模块相应接口的电平来控制电机的转向，结合电位器反馈的电平值及编码器反馈的信号，对摆杆的状态实施实时的维控。

PID算法

PID算法是一种闭环的自动控制器。它具有原理简单、易于实现、适用面广、控制参数相互独立，参数的选定较为简单等优点。当运用在具有反馈的系统中具有很好的自动调节能力，用在在本系统中十分合适。当电位器反馈摆杆发生位移时，其变化的模拟量被MCU的AD所采集，MCU运用PID算法选用合适的计算方式，以控制电机的转向及转速，进而对摆杆的实时位置进行微控，已完成题目的要求。PID算法流程见附件一

3、摆杆状态检测

本组采用电位器检测摆杆状态。电位器是具有三个引出端、阻值可按某种变化规律调节的电阻元件。当电刷沿电阻体移动时，在输出端即获得与位移量成一定关系的电阻值或电压。其具有极高的精确性，能够对角度的变化进行很好的测量。计算电位器与角度的关系，即可通过对电位器反馈的电平进行AD转换，以间接获得摆角，即摆杆的实时状态。

摆角与电位
器反馈值之间关系如下：