旋转倒立摆设计报告.docVIP

控制专题训练阶段性报告 旋转倒立摆设计 学生姓名： 2017年5月日 摘 要 32f103单片机作为中心控制系统，由精密电位器、电机驱动模块、电源电路组成。角度监测模块采用采用双向编码器，实时测量摆杆与垂直方向的夹角；电机驱动部分使用TB6612驱动芯片驱动直流电机较精确地控制摆杆的灵敏度；具有操作简单，控制界面直观、简洁，系统性能指标达到了设计要求，工作可靠，功耗低，具有良好的人机交互性能。 关键字：STM32f103RC 精密电位器 TB6612 目 录 一、系统方案 1 1、摆架框架的论证与选择 1 2、驱动电机的选择 1 2、角度传感器的1 二、系统理论分析与计算 1 1、电机型号选择 1 2、摆杆状态监测 1 3、算法控制 1 （1）比例控制规律 1 （2）比例积分控制规律 1 （3）比例微分控制规律 1 （4）比例积分微分控制规律 1 三、电路与程序设计 2 1、电路的设计 2 （1）系统总体框图 2 （2）PID算法子系统框图 2 （3）主控制器模块设计 2 （4）电源 3 2、程序的设计 3 （1）程序功能描述与设计思路 3 （2）程序流程图 3 四、测试方案与测试结果 3 1、测试方案与论证 3 2、测试条件与仪器 4 3、测试结果及分析 4 （1）测试结果(数据) 4 （2）测试分析与结论 4 五、参考文献 4 附录1：电路原理图 5 附录2：源程序 6 一、系统方案 1、 方案一：采用木板做摆杆，材料方便，制作简单，质量较小，尽管在做旋转运动时，空气阻力对其有影响，木质材料的摆杆较轻，可以适当的加点配重，增加其惯性，更加方便电机对其旋摆随时的控制。 方案二：采用碳纤维杆做摆杆，相对于木质材料来说，碳纤维杆较细，表面光滑，质量与木质材料不差上下，如加以配重，重心偏移比木质材料大。 为更好保持稳定，减少系统本身可能导致的误差，综合以上两种方案，选择方案二。 2、 方案一：采用直流减速电机，直流减速电机，即齿轮减速电机，是在普通直流电机的基础上，加上配套齿轮减速箱。齿轮减速箱的作用是，提供较低的转速，较大的力矩。同时，齿轮箱不同的减速比可以提供不同的转速和力矩。 方案二：采用步进电机，步进电机能够通过给定的脉冲周期，实现任意速度的转动，定矩运动较精确。但是灵活性低，且转速慢。在此高灵活控制情况下难以满足要求。 考虑到灵活性和精确度，综合以上两种方案，选择方案一。 3、 方案一：采用单轴倾角传感器，它的最大刷新率为20ms,能够检测出垂直倾角，即在能以最大50Hz的采样频率把角度值反馈给单片机。但是在摆杆做周旋转的情况下，导线严重的影响了摆杆的旋转，并且导线在旋转的情况下可能会引起一系列的后果。 方案二：采用编码器作为角度传感器，双向编码器可以测出旋转角度及其运动方向，只需一个编码器直接安装在旋转臂的一端，编码器的转轴连接摆杆，代替了转轴的制作，安装方便。 方案三使用精密电位器做角度传感器使用方便加.3V电压就可以直接读出读数使用stm32内部ad读取精度较高且可以很快读取系统理论分析与计算 1、 由于本次设计要求电机灵敏性高，并且扭矩大，所以本次设计选择减速直流电机。在普通直流电机的基础上，加上配套齿轮减速箱，提供较低的转速，较大的力矩。适合本次设计要求的扭矩大、动作快的要求。 2、 出于旋转要求的限制，通过导线将角度传感器固定在摆杆上的测试方法已经不能满足要求了，本次设计采用了精密电位器，它是利用电位器原理，旋转主轴可以改变接入电阻值的设备。根据电压的分压原理，使用AD读取接入部分的电压就可以检测接入部分的角度。用他可以实现角位移及其他物理量的精确测量,具有精度高、测量范围广、使用可靠等优点。 3、 本次设计的算法是基于PID算法上进行的。PID是一个有比例(P)、积分(I)、微分(D)控制闭环控制算法 （1）比例控制规律P： 采用P控制规律能较快地克服扰动的影响，它的作用于输出值较快，但不能很好稳定在一个理想的数值，不良的结果是虽较能有效的克服扰动的影响，但有余差出现。它适用于控制通道滞后较小、负荷变化不大、控制要求不高、被控参数允许在一定范围内有余差的场合。如：金彪公用工程部下设的水泵房冷、热水池水位控制；油泵房中间油罐油位控制等。? （2）比例积分控制规律(PI)： 在工程中比例积分控制规律是应用最广泛的一种控制规律。积分能在比例的基础上消除余差，它适用于控制通道滞后较小、负荷变化不大、被控参数不允许有余差的场合。如：在主线窑头重油换向室中F1401到F1419号枪的重油流量控制系统；油泵房供油管流量控制系统；退火窑各区温度调节系统等。 （3）比例微分控制规律(PD)： 微分具有超前作用，对于具有容量滞后的控制通道，引入微分参与控制，在微分项设置得当的情况下，对于提高系