倒立摆电子设计94264626.doc

倒立摆电子设计论文摘要本次竞赛C题的任务为设计并制作一个旋转式倒立摆,能够使摆杆做圆周运动，并且实现倒立功能对此我们的作品采用自制支架，旋臂和摆杆.电机采用伺服电机,以STＣ12C5A６0Ｓ２为控制芯片，利用精密塑料电位计测量摆杆转角，经过数学建模和多次数据采集建立模糊数学模型,利用PＩD实现对摆杆的实时控制关键词:STC1２C５A60Ｓ2　塑料电位计 PID控制器一、 设计任务1、任务设计并制作一套简易旋转倒立摆及其控制装置.旋转倒立摆的结构如下图1所示.电动机A固定在支架Ｂ上，通过转轴Ｆ驱动旋转臂C旋转.摆杆E通过转轴D固定在旋转臂C的一端，当旋转臂C在电动机A驱动下作往复旋转运动时，带动摆杆E在垂直于旋转臂Ｃ的平面作自由旋转　2、基本要求 （1）摆杆从出于自然下垂状态（摆角）开始，驱动电机带动旋转臂做往复旋转使摆杆摆动，并尽快使摆角达到或超过； （2）从摆杆出于自然下垂状态开始,尽快增大摆杆的摆动幅度，直至完成圆周运动； （3)在摆杆出于自然下垂状态下，外力拉起摆杆至接近位置,外力撤除同时，启动控制旋转臂使摆杆保持倒立状态时间不少于5ｓ，期间旋转臂的转动角度不大于3、 发挥部分 (1）从摆杆处于自然下垂状态开始，控制旋转臂作往复旋转运动，尽快使摆杆摆起倒立，保持倒立时间不少于10ｓ； (2）在摆杆保持倒立状态下，施加干扰后摆杆能继续保持倒立或 2s　内恢复倒立状态;(3）在摆杆保持倒立状态的前提下，旋转臂作圆周运动，并尽快使单方向转过角度达到或超过　36０°；（4） 其他。

二、系统方案 1、系统结构旋转式倒立摆的机械结构主要包括旋臂、摆杆、直流减速电机以及角位移传感器部分其中直流减速电机为执行机构,由电机驱动芯片L29８驱动旋臂和摆杆之间由角位移传感器连接，摆杆可绕旋臂在垂直平面内转动旋臂和摆杆的角位移信号由角位移传感器测量的到,作为系统的输入量送入到控制其中，根据一定算法计算得到控制律并转化为电压信号提供给驱动芯片,来驱动直流减速电机转动,从而带动旋臂在水平面内旋转,最终实现控制摆杆直立的效果 2、方案比较与选择 2.1机械结构模块旋臂质量 m1020０Ｋg摆杆质量　m2０.05２Kg旋臂长度 R1（R）０20m摆杆长度 R２０.20m旋臂质心到转轴距离L1０．0１m摆杆质心到转轴距离Ｌ２０．12m电机力矩—电压比Km０0２3６Ｎm/V电机反电势－转速比Ke0．28６5VS旋臂饶轴转动摩擦力系数F10．01NmS摆杆绕轴转动摩擦力矩系数F20．00１NmＳ旋臂绕轴转动惯量Ｊ１０00４Kg摆杆绕轴转动惯量J20.０01Kｇ 旋臂部分：材料不易变形,质量轻，转动灵便，因此采用铝合金板 　　摆杆部分：需要材料密度大，转动灵便,刚性好，最终使用碳纤维杆，并在端头加一配重. 支架部分：稳定性好。

22微控制器模块的论证与分析方案一:ＳＴC１2C5A6０S２单片机是单时钟/机器周期(１T）的单片机，是高速/低功耗/超强抗干扰的新一代805１单片机,指令代码完全兼容传统８0５1,但速度快8－１2倍内部集成MＡX81０专用复位电路,２路PWM,8路高速10位A／D转换（25０k/s，即25万次/秒)，抗干扰性强，所以此类芯片控制电机时，对传感器信号的处理仍然很好，另外该类单片机价格也仅是略高于SＴＣ89C５1系列单片机，具备更高的性价比.方案二：采用AVR系列单片机AＶR系列单片机是一款具有增强型内置Flash的高速8位单片机.其采用精简指令集，功耗低，性价比高ATMＥGA１6有１6K字节的系统内可编程Flaｓh,５12字节的EＥPＲＯＭ,1Ｋ字节的SRAM但对于该题目其功能会有大量冗余方案三：采用可编程CPLＤCPLD可以实现各种复杂的逻辑功能,规模大、密度高、体积小、稳定性高、I/O资源丰富、易于进行功能扩展其采用并行的输入输出方式,提高了系统的处理速度，适合作为大规模控制系统的控制核心但本系统不需要复杂的逻辑功能，对数据的处理速度的要求也不是非常高，且从使用及经济的角度考虑,此方案不是最佳选择。

综上所述,选择方案一.　 　23电机的论证与分析方案一：直流减速电机具有调速范围宽，线性特性好,起动转矩大，响应速度快，质量轻，体积小等优点，但存在减速箱,齿轮减速存在空程，不利于实现精确控制方案二：步进电机具有能够直接实现数字控制,抗干扰性强,控制性能好，控制原理简单,误差不长期累积等优点,但需要专门的电源和驱动器，采用普通驱动器时效率低,并且运动增量或步距角固定,承受惯性负载能力低，在低速运行时有可能发生震荡现象，体积较大方案三:直流伺服电机伺服电机（sｅrvｏ moｔor　）是指在伺服系统中控制机械元件运转的发动机，是一种补助马达间接变速装置.伺服电机可使控制速度，位置精度非常准确,可以将电压信号转化为转矩和转速以驱动控制对象伺服电机转子转速受输入信号控制,并能快速反应,在自动控制系统中，用作执行元件，且具有机电时间常数小、线性度高、始动电压等特性，可把所收到的电信号转换成电动机轴上的角位移或角速度输出综上所述,选择方案三 2．４电机驱动模块的论证与分析方案一:采用大功率三极管，二极管,电容，电阻等元件采用上述元件搭建两个H桥，通过对各路信号放大来驱动电机，原理简单,易于明了.但由于放大电路很难做到完全一致,当电机的功率较大时，运行不稳定，而且电路的制作也比较复杂。

方案二：采用L２98Ｎ驱动芯片Ｌ29８Ｎ芯片是常用的电机驱动芯片该芯片有两个ＴTL/CMＯS 兼容电平的输入，具有良好的抗干扰性能；其输出电压最高可达５０V,可用单片机的I/O口提供信号,而且一块L2９８芯片可驱动一个步进电机,驱动电路简单易用、稳定可靠，具有较高的性价比 综上所述，选择方案二 　２5角度传感器模块的论证与分析方案一：导电塑料电位器导电塑料电位器是把一个机械位移转换成电气信号，并且该信号能够与机械运动成正比.电刷装配连接到机械激励器,继而使塑料阻轨产生一个电压分配器电位计的阻轨两端(１,３ ）连接到稳定的直流电压(允许小电流).当在电刷和修正阻轨之间测量时,信号电压是电压分配器的主要部分，并且与阻轨上的电刷位置成正比对于某一固定角度阻止一定，线性度好，软件程序简单,方便控制，但硬件电路复杂，性价比高方案二：光电编码器光电编码器检测的精度高，硬件电路简单，但软件程序复杂,不易检测摆杆摆动方向，且价格比较昂贵，性价比低综上所述,选择方案一2.６显示模块的论证与分析方案一:使用MＡX7219芯片的数码管显示数码管基本可以满足系统的显示需求，且能够自发光，使显示更加清晰，但消耗电流较大，占用单片机端口多.加上MAX７２19后解决了数码管占用单片机端口较多的问题，能够用单片机的3个Ｉ／O口控制8个数码管.方案二：采用1６０２ＬＣD显示器显示。

其功耗小，极其省电，但是使用有温度范围限制，且因是反光式的,在外界光线很明亮的情况下很容易看不清楚综上所述，选择方案一.　2.7稳压模块的论证与分析方案一：ＬM2940-50低压差三端稳压芯片输出电压固定的低压差三端稳压器；输出电压5V;输出电流1A；输出电流１Ａ时，最小输入输出电压差小于08V；最大输入电压26V;工作温度—４0～+１2５℃;内含静态电流降低电路、电流限制、过热保护、电池反接和反插入保护电路方案二：直流稳压电源直流稳压电源电压调节方便，可调范围宽，但其体积大,携带不容易，且须2２0V室电综上所述，选择方案一 3.总方案设计框图三、理论分析与计算　　１、电动机选型　 直流伺服电动机额定电压6V额定电流0.4A力矩约005 N/ｍ额定转速１000r/miｎ使用减速装置减速比１／１０ ２、摆杆状态检测２.1理论分析　 导电塑料电位器的功能是把一个机械位移转换成电气信号，并且该信号能够与机械运动成正比.电刷装配连接到机械激励器，继而使塑料阻轨产生一个电压分配器.电位计的阻轨两端（1,３　）连接到稳定的直流电压(允许小电流)当在电刷和修正阻轨之间测量时，信号电压是电压分配器的主要部分,并且与阻轨上的电刷位置成正比。

导电塑料电位器作为一个电压分配器,可以不必着重于阻轨上的总电阻的准确度，因为温度波动只对电阻产生作用，不会影响到测量结果.２2计算22.1线性度 一个特殊的一致性类型,理论功能特征是一条直线 √　Vo　= ƒ(Ө）＋/-C=A（Ө)+B+／－C Ө=0时,A 是斜面,B　是截距.　22独立线性 最大的实际功能特征误差，计算出一条最适合的基准直线的斜面和位置,把误差降到最小它用在特定的理论电气行程中测量出来的总电压的百分比来表示 　 3、驱动与控制算法　 ３.1水平式旋转倒立摆系统建模 　　水平式旋转倒立摆系统由一份水平悬臂和一级摆杆组成,悬臂由电机驱动在水平面内做圆周运动，通过耦合作用带动摆杆转动 　 假设水平式旋转倒立摆系统中,悬臂的长度和质量分别是L1、ｍ１，相对其水平方向零位的角位移为1,角速度为,摆杆的长度和质量分别为L2、ｍ2，相对其竖直方向零位的角位移为2 角速度为，电位器质量为m３建立如下图所示坐标系1.系统总动能（1） 摆杆动能 　 旋臂和摆杆的连接点为Ｂ,对于距B点l2处,长为dｌ的一小段,其坐标为：　　 　 (2－３) 3. 拉格朗日方程 由以上分析知，拉格朗日算子 　 　 　 （2－8）　 ﻩ　（２-９）　 　 　 （２—11) 　　 　 　 　(2－１2） 　　 　　　　 　 　　　 　(2－1３） 　 　 　 （２-14) 　 　 　　 　 　 　　 （2－15)3.2　ＰID控制器C语言算法int　kp,ki,ｋd，e2，ｅ１，sume,u； ／/PID控制参数　kp：比例系数 ki：积分系数 kｄ：微分系数 　 　 　 　 　//e０：当前偏差 e1:前一次偏差 ｅ2：前二次偏差 sumｅ：偏差累积和ｉｎt ＰＩＤ1（） 　／/增量式PID控制算法: 只需要当前时刻以前３个时刻的误差，　　 　 　 //计算误差与精度不足时对控制量的计算影响较小｛ int ｅ0; ｉｎｔ u； e０=seti—Stｅmp； //当前偏差=设定液位值 - 当前实时液位值 e２=e１;ｅ1=e0；　 ｕ=kp*（e0-e1）　+ ki＊ｅ0　+　kd＊（e０-2＊e1+e2）； iｆ(ｕ＜３０) u=30； /／对应电压或电机的死区范围，需测试 iｆ(ｕ＞PWＭ_ＭAX) u=PWM_MAX—10;//对应最大PWM限制或电压死区，需测试　 rｅtuｒｎ u;/／设置ＰWＭ脉冲数据｝3。

3主程序流程图ﻩ程序流程图见下图示程序流程图示四、测试方案与测试结果 　1、测试过程根据电路图连接好硬件电路，下载程序到STC1２C5A60Ｓ2单片机中,观察摆杆摆动角度，通过对程序的调试，实时调试摆杆摆动角度,以达到技术要求，使摆杆摆动角度加大直至可以做圆周运动,且可以实现倒立 2、测试仪器数字示波。