1自动追光自动壁障电动小车(B题)2摘要:本电动小车系统是用飞思卡尔公司生产的16位MC9S12XS128单片机作为主控制芯片,2片MC33886作为驱动芯片控制小车左右两路直流电机,电动小车模型采用左右两路直流电机驱动四轮,车模精简、稳定性高。左右两电机差速实现转向功能,小车简易减速齿轮箱,各装有两个编码器,实现左右各两轮的测速,方便小车转向定位。小车供电系统是由3路低压差2940稳压芯片构成的。小车壁障传感器采用超声波传感器,精确测得障碍物距离小车位置,以实现小车及时躲避障碍物。小车追光系统采用3个光敏电阻成圆弧形摆布置于单舵机构成的机构上,实现实时锁定光源,完成追光壁障功能。根据实测结果,表明所设计的系统性能指标完全达到题目基本要求,发挥部分也已经完全满足题目要求。关键字:MC9S12XS128单片机转向定位超声波传感器单舵机摇头机械结构3目录1引言..........................................................42方案设计......................................................42.1设计思路................................................42.2系统整体结构............................................42.3单元模块设计方案选择....................................52.3.1小车底盘..........................................52.3.2单片机控制部分....................................52.3.3电机驱动电路......................................52.3.4壁障追光传感器选择................................52.3.5追光系统机械结构..................................62.3.6太阳能充电系统....................................63设计实现......................................................63.1场地的实现..............................................63.2控制和伺服电路设计......................................63.3小车壁障的实现..........................................73.4跟踪引导算法的实现......................................73.5太阳能板追光和引导的实现.................................73.6小车停车的实现..........................................83.7太阳能充电系统实现......................................84系统测试......................................................84.1测试仪器................................................84.2测试方法................................................84.3测试结果................................................84.4测试结果分析............................................95结论..........................................................9参考资料........................................................9附录1系统硬件原理图...........................................10附录2程序清单.................................................114自动追光自动壁障电动小车1引言为了满足题目要求,本电动小车系统采用超声波传感器精确定位障碍物位置实现壁障;用光敏电阻寻找光源,光敏电阻置于摇头机构上,完成光源的准确追踪;太阳能充电系统;整个小车系统硬件电路紧凑、对称、整齐,机械结构合理,重心稳定。整个小车系统很好地达到了题目要求。2方案设计2.1设计思路为设计一集追光、壁障、太阳能智能充电系统于一体的智能小车系统,本参赛队采用飞思卡尔公司生产的16位MC9S12XS128单片机作为控制芯片,电机驱动芯片MC33886控制小车系统的RS-260直流电机,动力强劲。为实现测速功能,使用了2个100线的编码器,利用XS128输入捕捉功能进行测速。供电系统用3片低压差稳压芯片2940构成3路供电系统。自行制作了超声波测距模块,实现3米内障碍物位置测定,模块工作稳定。伺服舵机构成的双自由度云台进行对光源的定位。2.2系统整体结构系统硬件原理图见附录1。系统结构框图如图1所示。图1系统结构框图本智能追光壁障可太阳能充电小车是以控制芯片MC9S12XS128辅以外围电XS128寻光系统MC33886舵机编码器输出模块超声波收发模块2940供电系统太阳能充电系统5路设计而成。用电机驱动芯片MC33886提供动力,超声波传感器实现壁障,光敏电阻组成的检测光源追光系统,独立的太阳能充电系统,从而组成此基本追光壁障太阳能可充电智能小车。2.3单元模块设计方案选择2.3.1小车底盘方案1:采用双直流减速电机各驱动两轮,配以万向轮转向的小车底盘。此种小车底盘转向灵活,易于控制,便于壁障。但小车载重较多时重心不稳,更不利于双自由度云台实时追踪光源。方案2:采用飞思卡尔智能车车模,有舵机控制转向,精准,但其转弯半径较大,不利于壁障,动力强劲,容易过冲。方案3:采用双直流电机驱动四轮的机器人平台小车底盘,小车机械结构紧凑,重心稳,易于负重。采用双轮差速配合编码器测速,可以实现转向定位。综上3种方案,为了保证小车载重多时重心较稳,易于负重,本参赛队选择方案3作为壁障追光小车系统的小车底盘。2.3.2单片机控制部分方案1:采用STC公司生产的最新产品STC12C5A60S2,此单片机具有两路PWM/PCA功能,8路AD采集,双串口,内部时钟总线最高可达35Mhz。但本电动小车系统所需PWM输出较多,用定时器模拟非常麻烦。方案2:采用飞思卡尔公司生产的MC9S12XS128单片机,此单片机具有8路PWM,16路AD采集通道,2个UART,2个硬件SPI,具有背景调试功能,方便实时查看程序中全局变量的值,具有80个引脚,硬件资源相当丰富。综上2种方案,因所需PWM输出较多,本参赛队选择方案2作为控制芯片。2.3.3电机驱动电路方案1:采用直流电机驱动芯片L298,驱动电流可达1.2A,外围器件较简单,但体积较大,引脚呈两排,间距小,不利于手工焊接连线。方案2:采用直流电机驱动芯片MC33886,驱动电流可达2A,外围器件简单,贴片封装体积小,采用DIP转接板后,较利于手工焊接。综上2种方案,为减少芯片占板面积,利于手工焊接,本参赛队选择方案2作为电机驱动电路芯片。2.3.4壁障追光传感器选择方案1:壁障传感器采用超声波模块,测距精准无干扰,追光传感器用光敏电阻,光敏电阻对光线敏感,电阻值在亮暗环境下相差甚大。光敏电阻配合筒状遮体,可以精准地对光线实现定位。方案2:壁障传感器采用光电开关,测距亦较精准,追光传感器采用光敏二极管或光敏三极管,采集的是开关量,追踪光源精度较低。6综上2种方案,为使测距精准无干扰,且追踪光源精度高,本参赛队选择方案1的超声波模块和光敏电阻。2.3.5追光系统机械结构方案1:采用单舵机机械结构,U型件固定的太阳能电池板和追光系统在机械结构上并不复杂。左右摆动控制太阳能电池板面对光源的朝向,架设位置适中,单舵机程序中算法实现较协调,算法处理后舵机总是可以单输出锁定光源。方案2:采用双舵机构成的双自由度云台机械结构,U型舵机支架和舵机底盘支架固定双舵机,太阳能电池板固定位置可能超过25cm。双舵机输出位置在算法中控制复杂,在时间有限的情况下未必可以实现。综上2种方案,为使车体整体高度适中,算法较协调易实现,本参赛队选择方案1的单舵机机械结构固定追光系统和太阳能电池板。2.3.6太阳能充电系统方案1:采用大功率太阳能电池板用继电器控制直接给蓄电池充电,由单片机内部AD通过精密分压电阻采集此时发电电压和电池电压,换算成功率,当电池板发电功率大于蓄电池功率,继电器接通充电电路。但可能使被充电电池电压会在很短时间上升,造成虚电压,若不加控制,电池电压会继续上升高于其额定电压,造成危险。方案2:采用功率适中,面积适中的电池板,使用PWM脉宽调制的方式去控制MOS管的导通,从而利用PWM的占空比去控制充电电流,并联一个指示灯,通过指示灯的明暗程度,直观的显示此时的充电状态强弱,再结合单片机对光电板和电池电压的采集比较,当电池电压接近其额定电压,改用较小充电电流,提高浮充电压点,尽量减弱虚电压作用,达到理想的充电状态。综上2种方案,方案1功率电池板面积较大,重量较重,增加小车负载,使转动惯量大,转向定位精度下降,充电不易控制,充电效果不好,故本队选用方案2脉宽调制充电方式。3设计实现3.1场地的实现本参赛队在四天三夜制作智能小车过程中,队员间相互协作,手工利用KT板制作题目要求的场地和障碍物。光源用100W的白炽灯模拟,同时对白炽灯产生的光进行凹面半球形聚光。场地面积分别为1.5m*1.5m和2m*2m两块场地。15cm*15cm*15cm的正方体障碍物。在1.5m*1.5m范围内随机摆放3个障碍物,光源在1.5m固定位置摆放,高度25cm。3.2控制和伺服电路设计以XS128为核心控制芯片,超声波实时发送声波,检测障碍物,根据光敏电阻状态,单片机控制舵机带动太阳能电池板转向始终面向光源,并根据舵机转向7控制小车行进,左右测速电机实时反馈出小车运行状态提供给单片机进行数据分析。3.3小车壁障的实现小车驶入场地后,如若遇到障碍物,超声波检测障碍物距离,障碍物在车体前20cm以内位置,车体调节转向以躲避障碍物。在检测到光源情况下,车体在壁障时太阳能电池板和追光系统锁定光源位置,车体进行转向以实现壁障同时追踪光源。3.4跟踪引导算法实现在没有障碍物的情况下,光源位置指导小车前进,即进行追光,太阳能电池正对光源对蓄电池进行充电,有障碍物时壁障,小车离光源一定位置时停车。程序流程图如图2所示。图2程序流程图3.5太阳能板追光和引导的实现利用光敏电阻对环境亮暗的敏感性设计寻找光源传感器,即光敏电阻和已知电阻的分压电路,采集光敏电阻端和已知电阻端间电压,通过模拟量的电压分析,即可模糊地判断光线的强弱。与另两路寻光传感器电路中得到的电压值相比较,即可判断出光源的位置。利用单舵机机械结构实时把光源位置方向锁在正中间光敏电阻所对方向。由于光敏电阻对环境的敏感性,导致环境中的散光造成的同一规格的光敏电阻在相同照度下电阻值不同。为此,在每个光敏电阻前加筒状遮体,使光敏电阻的基准电阻值基本相同,为检测光源时三者电阻值的比较有统一标准,提高光源检测是否有光源开始设定初始值锁定光源检测是否有障碍壁障继续前进距离是否可停车光源指导前进停车YYYNNN8检测的精确度。采集的电压值为模拟量,提高了光源检测的空间精度,模拟量亦可以作比较,赋相应的比例系数、微分系数代入舵机控制软件模块。光敏电阻检测光源电路