一個(gè)簡單的智能小車.c 程序

ID:162851 · 發(fā)表于 2017-2-3 13:27

一個(gè)簡單的智能小車.c 程序，P0口電機(jī)驅(qū)動(dòng)電路 L293D 2只后輪和一只萬向輪，5只紅外反射式傳感器，其中左右方向用2只，距離近，中遠(yuǎn)各一只，

#include<reg52.h>

sbitPF1=P1^0; //左方向紅外傳感器

sbitPF2=P1^1; //右方向紅外傳感器

sbitPJ1=P1^2; //近距離 15cm 紅外傳感器

sbitPJ2=P1^3; //中距離 30cm 紅外傳感器

sbitPJ3=P1^5; //遠(yuǎn)距離 50cm 紅外傳感器

sbitPA1=P0^0; //電機(jī)驅(qū)動(dòng)電路 L293D 左輪

sbitPA2=P0^1;

sbitPA=P0^4;

sbitPB1=P0^2; //電機(jī)驅(qū)動(dòng)電路 L293D 左輪

sbitPB2=P0^3;

sbitPB=P0^5;

voidmain(void) //主程序

{

P1=0x00; //程序初始化

P1=0xFF; //P1口置1

while(1) //循環(huán)

{

if(PJ2==1&&PJ2==1&&PJ3==0)// 距離判斷前進(jìn)

{

PA1=1; //前進(jìn)

PA2=0;

PA=1;

PB1=1;

PB2=0;

PB=1;

}

elseif(PJ1==1&&PJ2==1&&PJ3==1) // 距離判斷無信號停止

{

PA1=1; //無信號停止

PA2=0;

PA=0;

PB1=1;

PB2=0;

PB=0;

}

elseif(PJ1==0&&PJ2==0&&PJ3==0) // 距離判斷后退

{

PA1=0; //后退

PA2=1;

PA=1;

PB1=0;

PB2=1;

PB=1;

}

帳號		自動(dòng)登錄	找回密碼
密碼			立即注冊