找回密碼
 立即注冊

QQ登錄

只需一步,快速開始

搜索
查看: 1779|回復(fù): 1
打印 上一主題 下一主題
收起左側(cè)

智能小車.c 程序

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:162851 發(fā)表于 2017-2-3 10:44 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
      一個簡單的智能小車.c 程序,2只后輪和一只萬向輪,5只紅外反射式傳感器,其中左右方向用2只,距離近,中遠(yuǎn)各一只,電機(jī)驅(qū)動電路 L293D     只用方向控制程序,或者前進(jìn)停止后退程序時均正常,一旦將方向控制程序+前進(jìn)停止后退程序時 ,方向控制不能正常工作      敬請哪位老師看看問題出在哪里     謝謝!
      智能小車.c 程序


#include <reg52.h>
sbit PF1=P1^0;         //左方向 紅外傳感器  
sbit PF2=P1^1;          //右方向紅外傳感器
sbit PJ1=P1^2;         //近距離 15cm 紅外傳感器
sbit PJ2=P1^3;         //中距離 30cm 紅外傳感器
sbit PJ3=P1^5;         //遠(yuǎn)距離 50cm 紅外傳感器
sbit PA1=P0^0;           //電機(jī)驅(qū)動電路 L293D  左輪
sbit PA2=P0^1;
sbit PA=P0^4;
sbit PB1=P0^2;          //電機(jī)驅(qū)動電路 L293D  左輪
sbit PB2=P0^3;            
sbit PB=P0^5;
void main(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(PJ2==1&&PJ2==0&&PJ3==0&&PF1==1&&PF2==0) // 距離+方向判斷  左拐
             {
                  PA1=1;       //左拐
                  PA2=0;
                  PA=1;
                  PB1=1;
                  PB2=0;
                  PB=0;  
             }
            elseif(PJ2==1&&PJ2==0&&PJ3==0&&PF1==0&&PF2==1) // 距離+方向判斷      右拐
            {
                  PA1=1;       //右拐
                  PA2=0;
                  PA=0;
                  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;  
           }
      }
}



   

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏 分享淘帖 頂 踩

相關(guān)帖子

回復(fù)

使用道具 舉報

沙發(fā)
ID:79544 發(fā)表于 2017-2-8 21:56 | 只看該作者
你的紅外模塊是碰到障礙物為低電平還是高電平
回復(fù)

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規(guī)則

手機(jī)版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機(jī)教程網(wǎng)

快速回復(fù) 返回頂部 返回列表