|
一個簡單的智能小車.c 程序，P0口電機驅動電路 L293D 2只后輪和一只萬向輪，5只紅外反射式傳感器，其中左右方向用2只，距離近，中遠各一只，
#include<reg52.h> sbitPF1=P1^0; //左方向 紅外傳感器 sbitPF2=P1^1; //右方向 紅外傳感器 sbitPJ1=P1^2; //近距離 15cm 紅外傳感器 sbitPJ2=P1^3; //中距離 30cm 紅外傳感器 sbitPJ3=P1^5; //遠距離 50cm 紅外傳感器 sbitPA1=P0^0; //電機驅動電路 L293D 左輪 sbitPA2=P0^1; sbitPA=P0^4; sbitPB1=P0^2; //電機驅動電路 L293D 左輪 sbitPB2=P0^3; sbitPB=P0^5; voidmain(void) //主程序 { P1=0x00; //程序初始化 P1=0xFF; //P1口置1 while(1) //循環 { if(PJ2==1&&PJ2==1&&PJ3==0)// 距離判斷 前進 { PA1=1; //前進 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; } } }
| 
