2012年省电子竞赛设计报告项目名称:自平衡小车姓名:连文金、林冰财、陈立镔指导老师:吴进营、苏伟达、李汪彪、何志杰日期:2012年9月7日摘要:本组的智能小车底座采用的是网上淘宝的三轮两个电机驱动的底座,主控芯片为STC89C52,由黑白循迹采集模块对车道信息进行采集,将采集的信息传送到主控芯片,再由主控芯片发送相应的指令到电机驱动模块L298N,从而控制电机的运转模式。
关键词:STC89C52 L298N 色标传感器 E18-F10NK 自动循迹引言:近现代,随着电子科技的迅猛发展,人们对技术也提出了更高的要求。
汽车的智能化在提高汽车的行驶安全性,操作性等方面都有巨大的优势,在一些特殊的场合下也能满足一些特殊的需要。
智能小车系统涉及到自动控制,车辆工程,计算机等多个领域,是未来汽车智能化是一个不可避免的大趋势。
本文设计的小车以STC89C52为控制核心,用色标传感器 E18-F10NK作为检测元件实现小车的自动循迹前行。
一、系统设计本组智能小车的硬件主要有以STC89C52 作为核心的主控器部分、自动循迹部分、电机驱动部分。
1.1方案论证及选择:根据设计要求,可以有多种方法来实现小车的功能。
我们采用模块化思想,从各个单元电路选择入手进行整体方案的论证、比较与选择。
本方案以STC89C52作为主控芯片,通过按键进行模式的选择切换,按键一选择三轮循迹,按键二进行两轮循迹。
1.1.1模式一(三轮循迹):模式一(按键一控制):三轮循迹的时候,通过色标传感器和激光传感器进行实时的数据采集,反馈给主控芯片,主控芯片通过驱动L298来控制两路直流减速电机,从而保证路线的准确性。
引导线断开区域:由于小车是逆时针行走,考虑到惯性,五个传感器全部没有检测到,就直接一定程度上的左转,正好和惯性在一定程度上进行抵消,校正电机两轮电机的线性偏差。
直接从D区域走到E区域。
S型曲线:通过安装传感器,实地模拟所有经过的所有情况,来经过“S”型曲线。
加减速区域:经过第一个十字路线,设置标志位flag为1,第二个十字路线,设置标志位为2,第三个十字路线的时候,flag为3,flag为4时清零。
1.1.2模式二(两轮循迹):模式二(按键二控制):两轮循迹的时候,通过色标传感器、激光传感器进行路况分析,陀螺仪与加速度传感器集成模块通过倾角改变量来进行反馈给小车,保证小车的两轮平衡行驶。
两轮循迹方案(平衡、速度、方向控制)理论分析及计算当测量倾斜角度的传感器检测到车体产生倾斜时,控制系统根据测得的倾角产生一个相应的力矩,通过控制电机驱动两个车轮朝车身要倒下的方向运动,以保持小车自身的动态平衡。
两轮自平衡小车的运动主要由驱动两个轮子转动的电机产生的转动力矩所控制。
而我们在控制小车的平衡及运动时, 控制量也是轮子的转动力矩。
1.1.2.1平衡控制:平衡控制是通过负反馈来实现的,系统可以类比为一个倒立的单摆模型,因为车模只有两个轮子着地,车体会在轮子滚动的方向上发生倾斜。
控制轮子转动,抵消其在这个维度上倾斜的趋势就可以保持车体的平衡了。
对倒立车模进行数学建模,建立速度的比例微分负反馈控制,根据基本控制理论讨论车模通过闭环控制保持稳定的条件。
车模简化为高度为L ,质量为m 的简单倒立摆,它放置在可以左右移动的车轮上。
假设外力干扰引起车模产生角加速度)(t x 。
沿着垂直于车模地盘方向进行受力分析。
由图推导出车模倾角与车轮运动加速度)(t a 以及外力干扰加速度)(t x 之间的运动方程[2]:)(x )](cos[)()](sin[)(22t L t t a t g dt t d L +-=θθθ(1.1.2.1 - 1)在角度θ很小时,θθ=sin ,1cos =θ , 运动方程简化为:)()()()(22t Lx t a t g dt t d L +-=θθ (1.1.2.1 - 2)车模静止时,0)(=t a)()()(22tLxtgdttdL+=θθ(1.1.2.1 - 3)对应车模静止时,系统的输入输出的传递函数为:LgsXsYsH-==2s1)()()((1.1.2.1 - 4)此时系统具有两个极点Lgsp±=。
一个极点位于S平面的右半开面,车模不稳定。
通过对系统的拉氏分析,知当车模静止时,此时系统的一个极点位于S平面的右半平面,车模不稳定[3]。
因此引入比例、微分反馈控制(在角度控制中,与角度成比例的控制量称为比例控制,与角速度成比例的控制量称为微分控制,其中角速度是角度的微分)之后的系统如图2-2所示,其中ωθ2211,kaka==。
图2-2 加入比例微分反馈控制后的系统框图系统的传递函数为:LgksLkssXsYsH-++==1221)()()((1.1.2.1 - 5)此时系统的两个极点位于:LgkLkksp2)(41222--±-=(1.1.2.1 - 6)系统稳定需要两个极点都位于S平面的左半开平面,要满足这一点,需要0,21≥≥kgk,由此得出结论,当,21≥≥kgk时,直立车模可以稳定。
1.1.2.2速度控制:通过MPU-6050模块,测量加速度传感器获得的角度信号,与角速度传感器测得的信号进行对比,对比积分得到的角度与重力加速度得到的角度,使用他们之间的偏差改变陀螺仪的输出,从而使积分的角度逐渐跟踪到加速度传感器测得的角度。
这样对于加速度传感器给定的角度,经过比例、微分、积分环节之后产生的角度θ必然等于我们要测量的车模倾斜的角度,通过调节PWM 信号从而达到对小车的直立控制。
也就是利用PID 算法计算输出量,根据输出量控制PWM 。
1.1.2.2.1电机模型化分析和简化:可以将电机转速与施加在其上的电压之间的关系化成一个一阶惯性环节模型。
施加在电机上的一个阶跃电压)(t Eu ,电机的速度方程是:)(}1{)(1t u e Ek t T tm --=ω (1.2.2 .1- 7)式中,E 为电压;)(t u 为单位阶跃函数;1T 为时间常数;m k 为电机转速常数。
分析该式可知,电机运动分为两个阶段,加速阶段和恒速阶段。
其中,在加速阶段,电机带动车模后轮进行加速运行,加速度近似和施加在电机上的电压成正比,加速阶段的时间长度取决于时间常数1T 。
在恒速阶段,电机带动车模后轮进行恒速运行,运行速度与施加在电机上的电压成正比。
由此计算所得的加速度控制量a 再乘以一个比例系数即为施加在电机上的控制电压,通过调节PWM 信号,这样就可以保证小车的自平衡循迹直立状态。
1.1.2.3方向控制:控制两个电机之间的转动差速实现车模转向控制,可直接通过不同电压脉冲信号进行控制。
1.2.1车体方案选择方案一:自己动手制作小车底座,一方面材料欠缺,另一方面制作过程要花费大量时间,制作出来的小车还可能机械性能不够优异。
方案二:网上购买小车底座,结构简单,基本能够符合设计所需,机械性能相对有保障。
方案选择:方案一和二同时结合使用,直接使用之前闲置的小车底座进行改装。
1.2.2主控芯片方案一:51单片机芯片(比如STC89C52系列)优点:容易控制、操作简单、外设较少、成本较低、其低功耗、性能稳定,处理速度1M。
缺点:处理速度较慢,扩展性较低,外部资源相对较少。
方案二:ARM芯片(STM32)优点:低功耗,高性能,程序在不同核之间兼容性良好,包括多种通信接口,内核电压低至1.8V,可以选择睡眠,待机等多种低功耗模式,容易处理各种复杂接口,处理速度达72M。
操作资源丰富,包括10个定时器、两个12位1-Msample/s 模数转换器(交错模式下2-Msample/s)、两个12位数模转换器、两个I2C接口、五个USART接口和三个SPD 端口。
外设共有12条DMA通道,一个CRC计算单元。
缺点:操作相对复杂,价格相对较高。
方案选择:采用STC89C52单片机来实现本题目,电路简单,成本较低,经实验运行证明工作可靠,所以最后决定用STC89C52作为该控制系统的核心。
1.2.3稳压芯片选择方案选择:LM2596输出电流大,损耗功率小,带负载能力比较强,价格也不会很贵,所以用LM2596给单片机最小系统版供电、驱动模块、色标传感器模块、激光模块和陀螺仪模块供电。
1.2.4电机选择方案一:步进电机优点:可以精确控制小车的旋转角度缺点:由于内部构造原因,速度很慢,给一个脉冲延时一段时间,速度慢。
方案二:直流减速电机优点:速度快(同样的功率比马达驱动的速度快一倍(6V))缺点:速度很快的情况下,小车的角度不容易精确控制。
方案三:舵机优点:结构紧凑,易于安装调试,大扭力,成本低,容易控制角度,角度控制精确。
缺点:价格相对较高。
方案选择:选择方案二。
步进电机速度太慢,而且小车主要是实现循迹功能,所转过的角度不用太过精确,舵机的价格太贵,综上考虑选择直流电机。
1.2.5循迹模块方案一:激光循迹优点:反应灵敏,信号强,前瞻性非常好,做的好的话,可以达到1-2米左右,不易受自然光影响。
缺点:价格相对昂贵,相对不好调试,工作电流大。
方案二:红外循迹优点:输出电流相对较小,单个模块20mA-30mA。
缺点:距离短。
方案三:摄像头循迹优点:前瞻性好,控制精确。
缺点:程序复杂,数据量大,调试难度大。
方案四:色标传感器优点:可以检测特定颜色与颜色的差异。
缺点:价格相对昂贵。
方案选择:选择方案一和方案四相结合。
鉴于本次比赛只需完成预设轨迹,所以不用追求速度和时间,考虑到精度和灵敏度。
1.2.6两轮平衡数据采集方案一:MPU-6050模块优点:集加速器与陀螺仪于一体,是整合性6轴运动处理期间,相较于多组件方案,免除了组合陀螺仪与加速器时之轴间差的问题,减少了大量的包装空间;并且内置16位AD,是数字量输出,采用标准的IIC通讯协议,无需外接AD,降低成本。
缺点:由于MPU-6050是新产品,还没有太多人使用,所以资料少,并且采集速度比组件慢一些。
方案二:MMA7660+ENC-03R优点:采集速度快,资料多。
缺点:需要外置AD,存在轴间差的问题。
方案选择:比较两个方案,最终选择了方案一。
二、硬件设计及说明基本系统控制电路采用采用模块化设计,镍镉电池(7.2V 2000mA)通过2596稳压成5V给主控模块、色标传感器、激光传感器和陀螺仪供电,以单片机STC89C52作为主控单元,负责整个电路的资源分配,色标传感器和激光传感器分别采集路况信息进行分析,从而自动识别,两轮行驶时,通过陀螺仪来测试倾角的变化量,反馈给主控模块,从而来控制小车的平衡行驶。
2.1 硬件设计锂电池稳压电路红外循迹模块MCU最小系统版(STC89C52)陀螺仪模块298驱动模块2.1.1电路原理图主控电路图(包括2596稳压电路和色标传感电路)2.1.2 电机驱动:L298N为15个管角的单块集成电路,高电压,高电流,四通道驱动,设计用L298N来接收DTL或者TTL逻辑电平,驱动感性负载(比如继电器,直流和步进马达)和开关晶体管。