【《多传感器无人避障系统的软件设计及调试》2800字】_第1页
【《多传感器无人避障系统的软件设计及调试》2800字】_第2页
【《多传感器无人避障系统的软件设计及调试》2800字】_第3页
【《多传感器无人避障系统的软件设计及调试》2800字】_第4页
【《多传感器无人避障系统的软件设计及调试》2800字】_第5页
已阅读5页,还剩15页未读, 继续免费阅读

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

多传感器无人避障系统的软件设计及调试1.1总体程序设计本无人车使用直流电机带动无人车前进,以89C52单片机为控制核心,主要功能是控制无人车前进、后退和转向。本车装有多个红外传感器。当前方传感器检测到路面有障碍物时,将触发传感器,并为微控制器提供低电平。如果转向按键没有被按下,无人车右转,同时无人车左侧传感器有效。转向结束后,无人车直走,并用定时器记录无人车直行所用的时间t1。当左侧传感器无效时,无人车左转,让无人车靠近障碍物行驶,此时,左侧传感器有效,当左侧传感器无效时,无人车第二次左转。然后直走,同时定时器开始定时,当无人车走过t1时间后,无人车第二次右转。以上,无人车的避障过程结束,无人车重新开始直走,直到下一次前方的红外传感器检测到障碍物。如果无人车的转向按键被按下,则无人车绕障碍物左侧避障,原理同上。具体流程如下图1.1。图1.1程序流程图整个程序包括一个主程序和两个头文件。<AT89X51.H>定义了STC89C52单片机端口,和内部各种寄存器。<ZY-4WD_PWM.H>包含了定义单片机与外界连接的端口和无人车前进、后退、左右转向的子程序,还有通过PWM调速控制子程序,以及程序的中断定义。1.2主程序设计主程序如图1.2、1.3、1.4、1.5所示。图1.2主程序部分1图1.3主程序部分2图1.4主程序部分3图1.5主程序部分4第2-3行:调用头文件。第10-12行:定义变量。第13行:让无人车停止,给驱动部分接口发出低电平的信号。第14-20行:利用P1.2接口与程序配合。如果P1.2有一个下降沿,程序能够继续向下运行,无人车开始运动,蜂鸣器响50ms。如果P1.2一直为0,则程序停在这里,无人车不动。第22-28行:启动中断。第29行:开始进入无人车运行逻辑部分。第30-35行:配合中断部分,每0.5秒数码管闪一下。第39-46行:通过前方传感器和左右侧传感器传来的信号,和转向按键情况,判断转向标志位值。如果前方传感器有效,左侧传感器无效,右转标志位为0,转向按键未被按下,则把1赋给右转标志位;如果前方传感器有效,右侧传感器无效,左转标志位为0,转向按键被按下,则把1赋给左转标志位。第48-80行:如果右转标志位为1,则从右侧避过障碍物。无人车先右转,同时无人车左侧传感器有效。然后无人车直走,当左侧传感器无效时,无人车左转,并用定时器记无人车直行所用时间t1。无人车完成左转后直走,此时左侧传感器有效。当左侧传感器无效时,无人车第二次左转。然后直走,当无人车走过t1时间后,无人车第二次右转。以上,无人车避障过程结束,无人车重新开始直走。第81-115行:如果左转标志位为1,则从左侧避过障碍物。无人车先左转,同时无人车右侧传感器有效。然后无人车直走,当右侧传感器无效时,无人车右转,并用定时器记出无人车直行所用时间t1。无人车完成右转后直走,此时右侧传感器有效。当右侧传感器无效时,无人车第二次右转。然后直走,当无人车走过t1时间后,无人车第二次左转。以上,无人车避障过程结束,无人车重新开始直走。第118-121行:如果左右转向标志位均为0,前方没有障碍物,无人车直走。1.3子程序设计整个软件部分含有9个子程序。延时函数,蜂鸣器函数,无人车直走函数,无人车后退函数,无人车停止函数,无人车左转90度函数,无人车右转90度函数,左电机调速函数,右电机调速函数。1.1.1延时函数图1.6延时程序图1.6为延时函数,主要通过循环延时。总共循环次数为k*a*b=306k。1.1.2蜂鸣器函数图1.7蜂鸣器函数图1.7为蜂鸣器函数,调用一次,蜂鸣器鸣笛20ms。1.1.3直行函数图1.8无人车直行函数图1.8为无人车直走函数,PWM调速值固定为10。让两个电机都向前运动,使无人车向前运动。1.1.4停止函数图1.9停止函数图1.9为无人车停止函数,让两个电机都停止运动。无人车停止。1.1.5后退函数图1.10后退函数图1.10为无人车后退函数,PWM调速值固定为10,让两个电机都向后运动。无人车整体向后运动。1.1.6左转函数图1.11左转函数图1.11为无人车左转90度函数,PWM调速值固定为10,左电机后退,右电机前进,延时一段时间,使无人车转向90度。1.1.7右转函数图1.12右转函数图1.12为无人车右转90度函数,PWM调速值固定为10,右电机后退,左电机前进,延时一段时间,使无人车转向90度。1.1.8左电机调速函数图1.13左电机调速函数图1.13为左电机调速函数。PWM调速中,PWM总周期取值为20,当前时间随中断自加。同时定义PWM周期中为高电平时间,如果当前时间小于PWM周期中为高电平时间,PWM信号端为高电平;否则,PWM信号端为低电平。可以利用使能端进行PWM控制。ENA和ENB为使能端,当单片机给这两个端口输入的信号为1时,L298N才能根据IN1、IN2、IN3和IN4的输入控制电机的旋转情况;当单片机给这两个端口输入的信号为0时,电机停止。本系统采用20ms为一个周期,以占空比50%为固定速度,一周期中有10ms为高电平,10ms为低电平。无人车以一个固定的速度行驶。1.1.9右电机调速函数图1.14右电机调速函数图1.14为右电机调速函数,同左电机调速函数类似。1.4中断设计图1.15中断函数图1.15为中断函数,使用定时器0中断。给定时器赋初值,定时1ms。每一毫秒time自加一,time加到5000时,回到0重加。每500毫秒,标志位变一次,数码管0.5秒闪一下。PWM中当前时间随着中断自加,在PWM调速函数中,实现电机的PWM调速。因为本程序中PWM的设定值为常数10,所以无人车的速度不变。1.5端口定义图1.16端口定义第6-12行:定义无人车驱动模块I/O口。P1.2连驱动部分L298N的IN1口;P1.3连L298N的IN2口;P1.4连L298N的IN3口;P1.5连L298N的IN4口,P1.6、P1.7分别接L298N的使能端ENA和ENB。第16行:定义蜂鸣器接线。第17-27行:定义三个红外传感器、PWM信号端和转向按键。第29-34行:定义左右电机旋转。其中P1.2口所连的IN1和P1.3口所连的IN2控制左电机;P1.4口所连的IN3和P1.5口所连的IN4控制右电机。如果输入值为10,电机向前转;如果输入值为01,电机向后转;如果输入值为00,电机停转。第36-39行:PWM变量定义和左右电机占空比变量定义。第40-43行:定义电机停止位、时间变量和标志变量。第2章实验验证经过硬件组装和软件调试,可以得到一个完整的设计实物,如图5.1所示。图5.1无人车该无人车可以在检测到前方有障碍物时,手动控制转向按键,无人车可以从左右两个方向避障。如果不按转向按键,无人车遇到障碍物时,绕过障碍物右侧避障。如图5.2图5.2无人车遇到障碍物遇到障碍物右转,此时左侧传感器有效,开始计时。无人车前进。如图5.3图5.3无人车右转当左侧传感器无效时,无人车左转,结束计时,计时结果为t1。转向后左侧传感器有效。无人车前进。如图5.4、5.5图5.4无人车结束计时图5.5无人车左转当左侧传感器无效时,无人车第二次左转。转向后,无人车直行时间为t1。如图5.6、5.7图5.6无人车开始第二次左转图5.7无人车第二次左转结束无人车直行t1时间后,无人车第二次右转。避障完成,无人车直行。如图5.8图5.8无人车结束避障如果按下转向按键,无人车遇到障碍物时,绕过障碍物左侧避障。如图5.9图5.9无人车遇到障碍物遇到障碍物左转,此时右侧传感器有效,开始计时。无人车前进。如图5.10图5.10无人车左转当右侧传感器无效时,无人车右转,结束计时,计时结果为t1。转向后右侧传感

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论