#include<reg52.h>

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

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

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

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

sbitPJ3=P1^5;        //遠距離 50cm 紅外傳感器

sbitPA1=P0^0;           //電機驅(qū)動電路 L293D  左輪

sbitPA2=P0^1;

sbitPA=P0^4;

sbitPB1=P0^2;          //電機驅(qū)動電路 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)// 距離判斷  前進

    {

    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;

    }

  }

}