智能小车仿真程序_第1页
智能小车仿真程序_第2页
智能小车仿真程序_第3页
智能小车仿真程序_第4页
智能小车仿真程序_第5页
已阅读5页,还剩9页未读, 继续免费阅读

下载本文档

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

文档简介

#include<reg52.h>

#defineucharunsignedchar

#defineuintunsignedint

〃*********************第一部分Start**

51c5^C*^c*Jc

sbitINl=Pro;/7以下是电机驱动芯片L298管脚位声明

sbitPWMl=Pri;

sbitIN2;P「2;

sbitIN3二P「3;

sbitPWM2;Pr4;

sbitIN4=P「5;

sbitRPR3二Pr6;〃此处是传感器RPR220管脚位声明

sbitRPR4=P17

sbitRPR1=P2-O;

sbitRPR2二P2」;

sbitbzl=POP;//避障1

sbitbz2=P0\;/7避障2

sbitA=P3-2;〃默认为遥控避障工作模式,按下A键后小车变换为循迹避障

模式

sbitB=P0-3;〃按下B键不放,小车前进sbitC=P0'4;//按下C键不放,小

车左转弯sbitD=P0*5;//按下D键不放,小车右转弯sbitled=P0*7;

intn=l:

〃*********************第一部分End****

〃*********************第二部分子函数定义St

art************

/*********************************延时函数

*1**T*/

voidtimer(unsignedintt)〃中断计时{

unsignedinti;

for(i=0;i<t;i++)/*延时t*50ms*/

TM0D=0X10;

TH0=0x3C;

TL0=0xB0;

TR1=1;

while(JTFl);

TR1=O;

}

)

intO()interrupt0

(

n=n+l;〃默认遥控功能

if(n%2==0)

(

led=O;

)

elseled=l;

EA=1;

EXO=1;

ITO=1;

)

main()

EA=1;

EXO=1;

ITO=1;

whi1e(1)

(

while(n%2==l)

(

if(A==l)break;

if(A==O&&B==1&&bz1==1)

(

IN1=O,IN2=1,IN3=0,IN4=1;

PW1=1;

PW2=1;

timer(100);//5S

PWM1=O;

PWM2=0;

timer(100);//5S

)

if(A==0&&C==l&&bz1==1)

(

IN1=O,IN2=1,IN3=0,IN4=1;

PWM1=O;

PWM2=1;

timer(50);

PWM1=O;

PW2=1;

timer(50);

PW.M1=O;

PW2=0;

timer(10);

)

if(A==0&&D==1&&bz1==1)

IN1=O,IN2=1,IN3=0,IN4=1;

PWM1=1;

PWM2=0;

timer(50);

PWM1=1;

PW2=0;

timer(50);

PW1=O;

PWM2=0;

timer(10);

)

if(A==0&&bzl==0)

(

unsignedintk=0;

IN1=O,IN2=1,IN3=1,IN4=0;

for(k=0;k<=30;k++)

PW1=1;

PWM2=1;

timer(25);

PW1=O;

PW2=0;

timer(25);

}

)

)

while(n%2==0)

(

if(A==l)break;

if(A==O&&bz1==1&&((RPR4==0&&RPR3==0&&RPRl=0&&RPR2=0)

|(RPR1=O&&RPR2=1&&RPR3=1&&RPR4=0)))〃未检测到黑线,小车继续前

进

IN1=O,IN2=l,IN3=0,IN4=1;

PW1=1;

PWM2=1;

timer(100);

PW1=O;

PW2=0;

timer(400);

)

if(A=0&&bzl=l&&RPRl=0&&RPR2=二1&&RPR3=O&&RPR4=O)//仅左轮检测

到黑线,小车向左转弯{

IN1=O,IN2=l,IN3=0,IN4=1;

PWM1=1;

PW2=1;

timer(50);

PWM1=O;

PWM2=1;

timer(50);

PWM1=O;

PWM2=0;

timer(400);

)

if(A=0&&bzl=l&&RPRl=0&&RPR2:二0&&RPR3==1&&RPR4==0)//仅右轮检测

到黑线,小车向右转弯未检测到障碍物

{IN1=O,IN2=1,IN3=0,IN4=1;

PWM1=1;

PWM2=1;

timer(50);

PWM1=1;

PWM2=0;

timer(50);

PWM1=O;

PWM2=0;

timer(400);

)

if(A==0&&bz1==1&&RPR4==1&&RPR3==0&&RPRl==0&&RPR2==0)//右轮最外围

检测到黑线向右大转弯未检测到障碍物{

IN1=O,IN2=1,IN3=0,IN4=1;

PW1=1;

PW2=1;

timer(bO);

PWM1=1;

PWM2=0;

timer(100);

PWM1=O;

PWM2=0;

timer(50);

)

if(A=0&&bzl=l&&RPR4=0&&RPR3=二0&&RPRl=l&&RPR2=0)〃左轮最外围

检测到黑线左轮大转弯未检测到障碍物{

IN1=O,IN2=1,IN3=0,IN4=1;

PWM1=1;

PWM2=1;

timer(50);

PW1=O;

PWM2=1;

timer(100);

PW1=O;

PW2=0;

timer(400);

}

ir(A=0&&bzl=l&&RPR4=0&&RPR3=二0&&RPRl=l&&RPR2=l)//左转90°

弯未检测到障碍物

(

IN1=1,IN2=O,IN3=0,IN4=1;

while(RPR3==1)

(

PWM1=1;

PWM2=1;

timer(250);

PWM1=O;

PW=O;

timer(250);

)

)

if(A=0&&bzl=l&&RPR4=l&&RPR3:二1&&RPR1=O&&RPR2=O)〃右转90°弯

IN1=O,IN2=1,IN3=1,IN4=0;

while(RPR4==1)

(

PWM1=1;

PWM2=1;

timer(250);

PW1=O;

PWM2=0;

tinier(250);

)

}

if(A==O&&bzl=O)

unsignedintk=0;

for(k=0;k<=30;k++)

温馨提示

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

评论

0/150

提交评论