电子设计-电动车跷跷板

PAGEPAGE12大学生电子设计竞赛电动车跷跷板参赛学生：学校：赛前指导老师：2012年9月

电动车跷跷板摘要本设计采用两个凌阳SPCE061A16位单片机作为控制核心。其中一个安装在小车上，另一个持在使用者手中连接键盘和LCD，通过无线模块进行双机通讯，实现远程对小车运行状态的实时监测。为了对小车的行为进行精确控制，采用步进电机进行驱动。系统通过倾角传感器采集跷跷板的倾角变化后传给单片机。程序控制方法采用PID算法，使小车通过一个二阶欠阻尼脉冲响应过程最后趋于动态平衡。根据设计需要，车体采用有机玻璃与铝合金自制而成。关键词：SPCE061A单片机，角度传感器，光电传感器，PID算法.Abstract：ThissystemtakestwoSPCE061A16bitmicroprocessorasthecontrolcenter,onefixedonthecarandanotherconnectedwithkeyboardandLCDhandedbythecontroller.Inthissystem,wirelessisusedtocompletethetwoprocessors`communicationtoacquireaperfectinterfacebetweenthecontrollerandthewholecontrolsystem.Thecarwithfourwheelsisdrivenbytwosteppermotors,andthroughtheanglesensitivegatheringtheinformationabouttheteeterboard’sequinityconditionandthensendtothemicroprocessor.ThesystemtakesthePIDasmaincontrolmethod,throughaprogressoftwopulsedampingresponse,thecarandtheteeterboardfinallyreachanequinitycondition.Keywords:SPCE061Amicroprocessor,anglesensor,lightsensor,PID.1．系统方案设计1.1实现方法采用倾角传感器检测跷跷板与水平面的夹角，通过PID算法控制小车寻找平衡位置。当跷跷板在允许范围内满足达到平衡状态时，暂停5秒后行驶到跷跷板B端；当小车的上的四个光电开关同时检测到预先粘贴在跷跷板B端上的黑线时记数1，并倒车回到跷跷板A端，当四个光电开关第二次同时检测另一端的黑线时记数2，小车停止，此时基本部分完成。在发挥部分中，我们采用黑线引导小车走上跷跷板，小车启动时在水平位置，以此为标志来选择调用发挥部分所需要的程序，使小车在找到平衡之后停在原位并在收到扰动之后自动寻找新的平衡。在完成题目要求的同时，我们也做出了自己的特色。我们利用一个从单片机制作了一个手持观测系统，进行小车状态的实时播报和显示，另外还制作了电池低电压报警电路。1.2方案比较与论证1.2.1控制器模块由于题目要求的小车功能较多，如果采用一个单片机会使各模块之间的程序嵌套复杂，而且难以实现总体系统的稳定性要求。此外该控制系统程序庞大，包括角度传感器、光电传感器，LCD，语音模块，时钟等模块，一个单片机难以存储。所以我们采用两个SPCE061A16位单片机，一个为主控制器安装在小车上来控制小车的行驶，另一个为从单片机持在控制者手中，用来连接LCD，键盘以及语音模块。主从单片机之间采用无线通讯，实现两机之间的信息交流。这样不仅可以很好的解决上述问题，而且使人机交互界面变得更加方便完美，也更加人性化和智能化。1.2.2电机驱动模块方案一：采用H桥式电路驱动的直流电机作为小车驱动。直流减速电机输出力矩大，功耗相对较低，且运行平稳，但本题目需要对小车的位置进行精确步进控制，而直流电机输出轴之间存在一定间隙，而且不能精确定位控制，所以我们放弃此方案。方案二：采用输出力矩相对较大的步进电机，这样能够保证两个轮子的速度基本相同，实现了小车的精确控制。为了使步进电机低速时转动更平滑，采用专门的电机细分驱动芯片TA8435驱动电机，利用两个定时器控制电机速度，实现小车的速度与方向调整。实践证明该方案电路简单、控制方便且工作稳定。电路见附图一。所以我们选择方案二。1.2.3角度测量模块采用市场购买的低成本双轴倾角传感器ZCT245AL-485。ZCT245AL-485输出采用半双工通信方式RS485与单片机UART互通信息。它具有零角度设定，波特率可选等功能。ZCT245AL-485的精度高达0.1度，侧角范围正负45度，每秒送给单片机15次倾角值。完全可以满足本题目要求。测量方向见图1。程序见附录图1倾角传感器测量方向图21.2.4行进路线准直方案论证与选择在跷跷板上贴宽度为2cm的黑线，采用发射接收一体化的单光束反射取样式光电传感器RPR220作为敏感元件，利用红外线对不同颜色的反射系数不同而产生强弱电流信号，该方案受外界环境的影响比较小，抗干扰性比较强。如寻迹原理图所示，当1，2检测到黑线，3，4白色时，小车会通过差速左转直至1，2检测通时到黑线为止。电路图见附图2。程序见附录1.2.5显示及语音模块由于本设计采用的是凌阳SPCE061A单片机，其芯片内部具有专门的语音功能。本控制系统对于语音没有很高的要求，而且从单片机所承担的任务较少完全能够利用SPCE061A单片机自身资源实现语音功能。时间，角度以及路程的实时显示采用LCD模块OCMJ128x64，自带字库，编程简单，而且功能齐全。1.2.6电源模块为了减轻小车重量，方便小车自由行驶，我们采用可充电的大容量锂电池作为小车电源，输出电压12V。中间加装一个开关电源稳压至5伏，给单片机等控制电路供电，电源效率高，比7805等三端稳压器节省能源。1.3系统设计1.3.1系统总体方案经过上述的分析和论证，决定了系统各模块采用的最终方案如下：车体：由有机玻璃和铝合金片加工而成；主控单元：两个凌阳16位单片机SPCE061A；循迹模块：接收一体化红外传感器RPR220；倾角检测模块：数字式双轴倾角传感器（ZCT245AL-485）驱动模块：两相混合式步进电机42BYG021+TA8435细分驱动芯片语音播报模块：单片机自带D/A+基于SPY0030的功率放大电路+扬声器计时模块：DS1302和凌阳单片机内部时钟显示模块：OCMJ128x64LCD单片机无线通讯：半双工无线通讯模块nRF24011.4结构框图（见图3）图3系统结构框图2．理论分析与计算2.1测量与控制方法1).小车平衡的PID算法经过分析可得小车在翘翘板上寻找平衡点的是一个二阶欠阻尼震荡过程如图4：图4二阶欠阻尼震荡算法公式:，其中是比例环节，是积分环节，是微分环节。比例环节：及时成比例地反映控制系统的角度偏差信号，偏差一旦产生，通过角度传感器传给单片机，单片机立即产生调整控制信号，。其中常数使用来控制翘翘板达到平衡位置时与水平面的夹角。在题目要求中＝0即跷跷板要在水平位置平衡。积分环节：主要用于消除跷跷板趋于平衡时的稳态误差，提高系统的无差度。可是积分环节动态反映时间较长，这样虽然是系统更加稳定，但是却延长了系统的动态相应时间，而且算法复杂，考虑到该题目中的平衡的控制并不是很复杂，而且有允许在要求范围内存在些许误差，所以我们放弃积分环节。微分环节：微分环节能反映角度偏差信号的变化趋势(变化速率)，并能在角度偏差信号值变得太大之前，在系统中引入一个有效的早期修正信号，从而加快系统的动作速度，减小调节时间。在该微分控制中，控制器系统的输出速度与输入误差信号的微分(即角速度)成正比关系。微分环节使抑制误差的作用变化“超前”，即在误差接近0时，抑制误差的作用就应该是0。综合考虑我们决定采用PD算法来实现整个系统的平衡控制。公式为：。2.2理论计算确定参数小车启动时，=5度，=0度/秒，所以。小车由点A到点C大约需要10~20秒的时间，/AC/=80cm。，推出。可得出的取值范围在（0.8,1.6）区间之内。根据多次测试结果参数在区间（1，1.3）范围内时小车寻找的平衡的效果最好。2.3误差分析由于系统存在很多外在因素引起的误差，比如步进电机低速转动时的震动使角度传感器的制在一定范围内波动，因而对小车寻找平衡产生很大的干扰；即使小车处于平衡点时，跷跷板仍然存在微小的扰动，这些扰动会使小车不停的移动，从而大大延迟了小车调节平衡的时间，消除这些影响，我们设定当-2度<<2度时,比例环节作用关闭，当-1.4度<<1.4度时积分环节关闭，由此来消除外界环境因素及小车子身设计所带来的误差影响。3.电路与程序设计3.1检测与驱动电路电机驱动电路：电路见附图一：细分电机驱动芯片TA8435电路图直线寻迹模块：电路见附图二：光电对管寻迹电路图3.2总体电路图见附图三：系统总线图3.3软件设计与工作流程图该小车控制系统根据题目要求主要包括角度检测程序，时间显示，语音播报和寻迹程序等，以及我们在创新发挥部分自加的无线通讯模块。为了节省篇幅，在这我们只附上我们的程序流程图，（即图五）。图5程序流程图程序代码见附录：部分程序代码4.结果分析4.1创新发挥我们采用自制车体，题目要求实时显示小车各阶段所用的时间等信息，若将LCD安装在不断运动的小车上，观察极为不便，为此我们为了方便控制者实时观察小车的行驶状态，我们用一个从单片机制作了一个手持人机交换系统，与主单片机之间采用nRF2401相互交换信息。4.2结果分析1).测试仪器：PC机、秒表、卷尺；SPCE061单片机系统2).将系统的电机模块、直线行进模块、角度测量模块、液晶显示模块和语音模块分开测试，通调后在进行整机调试，以提高测试效率。3).测试结果及分析基础部分测试结果见表1：表1：基础部分测试结果测试次数A-C时间C点找平衡时间平衡时AB偏差C-B时间B-A时间显示时间实际时间时间误差一14s45s33mm16s33s112s108s4s二16s50s20mm14s40s125s120s5s三17s55s45mm19s55s146s151s5s平均15.3s50s36mm17s42.3s128s126s4s发挥部分测试结果见表2：表2：基础部分测试结果测试次数寻找平衡时间ＡＢ偏差显示时间时间误差配重一40s20mm43s3s配重二38s32mm39s1s配重三50s48mm53s3s5．总结经过半年的期待，两个月的精心准备，和四天三夜的奋战我们三人齐心协力闯过了层层难关完成了我们的跷跷板电动小车的题目。我们首先要感谢那些陪我们奋战的老师们,同时也要感谢大赛组委会成员老师能给我们提供这么难得的机会。6．参考文献黄智伟等,全国大学生电子设计竞赛训练教程.电子工业出版社,2005谭浩强,C程序设计(第二版).清华大学出版社,2000刘海成,秦进平等,MCU-DSP型单片机原理与应用北京航空航天大学出版社,2005戴佳,戴卫恒,51单片机C语言应用程序设计实例精讲电子工业出版社,2007谢自美,电子线路设计.实验.测试(第二版)华中科技大学出版社,2000附：图一：细分电机驱动芯片TA8435电路图图二：光电对管寻迹电路图图三：系统总线图部分程序代码调整平衡程序 /*************************************************************实验小车找平衡的过程，目的测试平衡函数的精准.*************************************************************/voidbalance3(){ forty++;} else forty=0;//开始接收倾角传感器发出的前三个角度，并储存在数组a[]中 if(key1==0){ a[key1]=t;} if(key1==1){ a[key1]=t;}if(key1==2){ a[key1]=t;}//通过PD算法和微调寻找平衡点key1++;if(key1>2){ a[2]=t; if((t>0)&&(a[1]<0)){ Speed(100,1); stop(1);} if((t>1)&&(a[1]>1)){if((a[1]-a[2])>0.2){ Speed(30,1); stop(1);}if((a[1]-a[2])<0.2){ if(bflag==0){Speed(400,1); stop(1);}if(bflag==1){Speed(10,1); stop(1);}} } if((t<-1)&&(a[1]<-1)){ bflag=1; if((a[1]-a[2])<0){Speed(10,1); stop(1);} if((a[1]-a[2])>0.5){ Speed(30,0); stop(1);} if(((a[1]-a[2])<0.5)&&((a[1]-a[2])>0)){ Speed(50,0); stop(1);} } if((t<0)&&(a[1]>0)){ Speed(100,0); stop(1);} if((t<=2)&&(t>=-2)){ // if(forty>=10){ if((a[1]-a[2])<=1.6) stop(20); // } }a[0]=a[1];a[1]=a[2];}}2．寻迹程序//************************寻迹函数****************************//检测到白为高电平，黑为低电平。void