標(biāo)題: 基于51單片機(jī)的智能迷宮小車(chē)設(shè)計(jì) 含PCB原理圖 源程序 [打印本頁(yè)]
作者: 51hei學(xué)習(xí)技術(shù)中    時(shí)間: 2017-3-4 03:24
標(biāo)題: 基于51單片機(jī)的智能迷宮小車(chē)設(shè)計(jì) 含PCB原理圖 源程序

單片機(jī)的智能迷宮小車(chē)的原理圖和pcb，都是用ad畫(huà)的








51單片機(jī)的智能迷宮小車(chē)的所有資料下載：
迷宮源程序.zip (112.56 KB, 下載次數(shù): 157)

小車(chē)電路圖.zip (2.37 MB, 下載次數(shù): 134)





下面是部分代碼預(yù)覽：
  1. #include<reg52.h>
  2. #include<stdio.h>
  3. #include <intrins.h>
  4. #include<string.h>
  5. #include<math.h>
  6. #define uchar unsigned char  //無(wú)符號(hào)字符型占用一個(gè)字節(jié) 范圍0~255,                          
  7. #define uint unsigned int  /*無(wú)符號(hào)整型占用二個(gè)字節(jié) 范圍0~65535*/
  8. #define dataPort P1
  9. uchar bianma1;           //編碼計(jì)數(shù)
  10. uint yejinjishu=0;        //液晶計(jì)數(shù)
  11. uchar wang=1;
  12. uchar guo=1;
  13. uchar  a1=0,a2=0,a3=0,a4=0;         //小車(chē)方向判斷
  14. uchar  b1=0,b2=0,b3=0,b4=0;

  16. //電機(jī)操作初始化
  17. uchar i=0,j=0; /* 中斷計(jì)數(shù)器 */  
  18. uchar m1=0; /* 電機(jī)1速度值 */  
  19. uchar m2=0; /* 電機(jī)2速度值 */   

  21. sbit s1=P0^0; /* L298的Input 1 */  
  22. sbit s2=P0^1; /* L298的Input 2 */  
  23. sbit s3=P0^2; /* L298的Input 3 */  
  24. sbit s4=P0^3; /* L298的Input 4 */
  25. sbit en1=P0^4; /* L298的Enable A */  
  26. sbit en2=P0^5; /* L298的Enable B */  

  28. //尋線 紅外接收頭 初始化
  29. sbit P2_2=P3^1;
  30. sbit P2_3=P2^3;
  31. sbit P2_4=P2^4;
  32. sbit P2_5=P2^5;
  33. sbit P2_6=P2^6;
  34. sbit P2_7=P2^7;

  36. //按鍵初始化
  37. sbit markkey=P2^0;  
  38. sbit logokey=P2^1;  
  39. uchar mark=0;  //選線while 標(biāo)志
  40. uchar logo=0;  //最佳路線行走標(biāo)記


  43. unsigned char idata road[30];         //轉(zhuǎn)向數(shù)組
  44. unsigned char code aa[10][4]={"LBL","LBA","ABL","ABA","ABR","RBA","RBR","RBL","LBR"};//數(shù)組無(wú)需改變 code
  45. unsigned char code  a[10][2]={"A","R","R","B","L","L","A","B","B"};
  46. unsigned char idata *p;   //地址寄存器 用于字符串操作
  47. //unsigned char idata  cun24c02[15];//ram允許情況可以無(wú)限添加 記憶數(shù)組


  50. // 函數(shù)初始化
  51. void KEY();
  52. void line();
  53. void stop();
  54. void youlun();
  55. void zuolun();
  56. void zhizou();
  57. void zhizou1();
  58. void zhizou2();
  59. void ISD1420p(uchar t1,uint t2);
  60. void Run_SNAKE(void);


  63. /********簡(jiǎn)易延時(shí)函數(shù)******/  
  64. void delay(uint t)
  65. {  
  66.     for(t;t>0;t--);  
  67. }

  69. void DelayUs(uint us)  //標(biāo)準(zhǔn)延時(shí) us
  70. {
  71. unsigned char uscnt;
  72. uscnt=us>>1;         
  73. while(--uscnt);
  74. }

  76. void DelayMs(uint ms)  //標(biāo)準(zhǔn)延時(shí) ms
  77. {
  78. while(--ms)
  79.    {
  80.      DelayUs(250);
  81.      DelayUs(250);
  82.      DelayUs(250);
  83.      DelayUs(250);
  84.    }
  85. }  



  89. //595 初始化 串轉(zhuǎn)并
  90. /*sbit sclk=P3^0;
  91. sbit dat=P3^1;       
  92. sbit st = P2^1;
  93. void write595(uchar wrdat)
  94. {
  95.   uchar sum;
  96.   for(sum=0;sum<8;sum++)
  97.      {
  98.                   sclk=0;
  99.                   dat=wrdat&0x80;
  100.                   wrdat<<=1;
  101.                   sclk=1;
  102.          }
  103.   st=0;
  104.   _nop_();
  105.   _nop_();
  106.   _nop_();
  107.   _nop_();
  108.   _nop_();
  109.   _nop_();
  110.   _nop_();
  111.   st=1;
  112. } */
  113. sbit SDA=P0^6;//sbit dat=P3^1;
  114. sbit SCL=P2^2;//sbit sclk=P3^0;
  115. sbit jiyibiaozhi=P0^7;//st = P2^1;
  116. void write595(uchar wrdat)
  117. {
  118.   uchar sum;
  119.   for(sum=0;sum<8;sum++)
  120.      {
  121.                   SCL=0;
  122.                   SDA=wrdat&0x80;
  123.                   wrdat<<=1;
  124.                   SCL=1;
  125.          }
  126.   jiyibiaozhi=0;
  127.   _nop_();
  128.   _nop_();
  129.   _nop_();
  130.   _nop_();
  131.   _nop_();
  132.   _nop_();
  133.   _nop_();
  134.   jiyibiaozhi=1;
  135. }

  137. /*******************************************************
  138. ********************************************************
  139. ***************24c02部分*********************************
  140. ********************************************************
  141. *******************************************************
  142. #define  _Nop()  _nop_()  //定義空指令                       
  143. bit ack;                      //應(yīng)答標(biāo)志位
  144. //sbit SDA=P2^1;
  145. //sbit SCL=P2^0;
  146. /*------------------------------------------------
  147.                     啟動(dòng)總線
  148. ------------------------------------------------
  149. void Start_I2c()
  150. {
  151.   SDA=1;   //發(fā)送起始條件的數(shù)據(jù)信號(hào)
  152.   _Nop();
  153.   SCL=1;
  154.   _Nop();    //起始條件建立時(shí)間大于4.7us,延時(shí)
  155.   _Nop();
  156.   _Nop();
  157.   _Nop();
  158.   _Nop();   
  159.   SDA=0;     //發(fā)送起始信號(hào)
  160.   _Nop();    //起始條件鎖定時(shí)間大于4μ
  161.   _Nop();
  162.   _Nop();
  163.   _Nop();
  164.   _Nop();      
  165.   SCL=0;    //鉗住I2C總線，準(zhǔn)備發(fā)送或接收數(shù)據(jù)
  166.   _Nop();
  167.   _Nop();
  168. }
  169. /*------------------------------------------------
  170.                     結(jié)束總線
  171. -----------------------------------------------
  172. void Stop_I2c()
  173. {
  174.   SDA=0;    //發(fā)送結(jié)束條件的數(shù)據(jù)信號(hào)
  175.   _Nop();   //發(fā)送結(jié)束條件的時(shí)鐘信號(hào)
  176.   SCL=1;    //結(jié)束條件建立時(shí)間大于4μ
  177.   _Nop();
  178.   _Nop();
  179.   _Nop();
  180.   _Nop();
  181.   _Nop();
  182.   SDA=1;    //發(fā)送I2C總線結(jié)束信號(hào)
  183.   _Nop();
  184.   _Nop();
  185.   _Nop();
  186.   _Nop();
  187. }
  188. /*----------------------------------------------------------------
  189.                  字節(jié)數(shù)據(jù)傳送函數(shù)               
  190. 函數(shù)原型: void  SendByte(unsigned char c);
  191. 功能:  將數(shù)據(jù)c發(fā)送出去,可以是地址,也可以是數(shù)據(jù),發(fā)完后等待應(yīng)答,并對(duì)
  192.      此狀態(tài)位進(jìn)行操作.(不應(yīng)答或非應(yīng)答都使ack=0 假)     
  193.      發(fā)送數(shù)據(jù)正常，ack=1; ack=0表示被控器無(wú)應(yīng)答或損壞。
  194. ------------------------------------------------------------------
  195. void  SendByte(unsigned char c)
  196. {
  197. unsigned char BitCnt;

  199. for(BitCnt=0;BitCnt<8;BitCnt++)  //要傳送的數(shù)據(jù)長(zhǎng)度為8位
  200.     {
  201.      if((c<<BitCnt)&0x80)SDA=1;   //判斷發(fā)送位
  202.        else  SDA=0;               
  203.      _Nop();
  204.      SCL=1;               //置時(shí)鐘線為高，通知被控器開(kāi)始接收數(shù)據(jù)位
  205.       _Nop();
  206.       _Nop();             //保證時(shí)鐘高電平周期大于4μ
  207.       _Nop();
  208.       _Nop();
  209.       _Nop();         
  210.      SCL=0;
  211.     }
  212.    
  213.     _Nop();
  214.     _Nop();
  215.     SDA=1;               //8位發(fā)送完后釋放數(shù)據(jù)線，準(zhǔn)備接收應(yīng)答位
  216.     _Nop();
  217.     _Nop();   
  218.     SCL=1;
  219.     _Nop();
  220.     _Nop();
  221.     _Nop();
  222.     if(SDA==1)ack=0;     
  223.        else ack=1;        //判斷是否接收到應(yīng)答信號(hào)
  224.     SCL=0;
  225.     _Nop();
  226.     _Nop();
  227. }

  229. /*----------------------------------------------------------------
  230.                  字節(jié)數(shù)據(jù)傳送函數(shù)               
  231. 函數(shù)原型: unsigned char  RcvByte();
  232. 功能:  用來(lái)接收從器件傳來(lái)的數(shù)據(jù),并判斷總線錯(cuò)誤(不發(fā)應(yīng)答信號(hào))，
  233.      發(fā)完后請(qǐng)用應(yīng)答函數(shù)。  
  234. ------------------------------------------------------------------       
  235. unsigned char  RcvByte()
  236. {
  237.   unsigned char retc;
  238.   unsigned char BitCnt;
  239.   
  240.   retc=0;
  241.   SDA=1;             //置數(shù)據(jù)線為輸入方式
  242.   for(BitCnt=0;BitCnt<8;BitCnt++)
  243.       {
  244.         _Nop();           
  245.         SCL=0;       //置時(shí)鐘線為低，準(zhǔn)備接收數(shù)據(jù)位
  246.         _Nop();
  247.         _Nop();      //時(shí)鐘低電平周期大于4.7us
  248.         _Nop();
  249.         _Nop();
  250.         _Nop();
  251.         SCL=1;       //置時(shí)鐘線為高使數(shù)據(jù)線上數(shù)據(jù)有效
  252.         _Nop();
  253.         _Nop();
  254.         retc=retc<<1;
  255.         if(SDA==1)retc=retc+1; //讀數(shù)據(jù)位,接收的數(shù)據(jù)位放入retc中
  256.         _Nop();
  257.         _Nop();
  258.       }
  259.   SCL=0;   
  260.   _Nop();
  261.   _Nop();
  262.   return(retc);
  263. }

  265. /*----------------------------------------------------------------
  266.                      應(yīng)答子函數(shù)
  267. 原型:  void Ack_I2c(void);

  269. ---------------------------------------------------------------
  270. void Ack_I2c(void)
  271. {
  272.   
  273.   SDA=0;     
  274.   _Nop();
  275.   _Nop();
  276.   _Nop();      
  277.   SCL=1;
  278.   _Nop();
  279.   _Nop();              //時(shí)鐘低電平周期大于4μ
  280.   _Nop();
  281.   _Nop();
  282.   _Nop();  
  283.   SCL=0;               //清時(shí)鐘線，鉗住I2C總線以便繼續(xù)接收
  284.   _Nop();
  285.   _Nop();   
  286. }
  287. /*----------------------------------------------------------------
  288.                      非應(yīng)答子函數(shù)
  289. 原型:  void NoAck_I2c(void);

  291. ----------------------------------------------------------------
  292. void NoAck_I2c(void)
  293. {
  294.   
  295.   SDA=1;
  296.   _Nop();
  297.   _Nop();
  298.   _Nop();      
  299.   SCL=1;
  300.   _Nop();
  301.   _Nop();              //時(shí)鐘低電平周期大于4μ
  302.   _Nop();
  303.   _Nop();
  304.   _Nop();  
  305.   SCL=0;                //清時(shí)鐘線，鉗住I2C總線以便繼續(xù)接收
  306.   _Nop();
  307.   _Nop();   
  308. }
  309. /*----------------------------------------------------------------
  310.                     向有子地址器件發(fā)送多字節(jié)數(shù)據(jù)函數(shù)               
  311. 函數(shù)原型: bit  ISendStr(unsigned char sla,unsigned char suba,ucahr *s,unsigned char no);  
  312. 功能:     從啟動(dòng)總線到發(fā)送地址，子地址,數(shù)據(jù)，結(jié)束總線的全過(guò)程,從器件
  313.           地址sla，子地址suba，發(fā)送內(nèi)容是s指向的內(nèi)容，發(fā)送no個(gè)字節(jié)。
  314.            如果返回1表示操作成功，否則操作有誤。
  315. 注意：    使用前必須已結(jié)束總線。
  316. ----------------------------------------------------------------
  317. bit ISendStr(unsigned char sla,unsigned char suba,unsigned char *s,unsigned char no)
  318. {
  319.    unsigned char i;
  320. for(i=0;i<no;i++)
  321.     {
  322.    Start_I2c();               //啟動(dòng)總線
  323.    SendByte(sla);             //發(fā)送器件地址
  324.      if(ack==0)return(0);
  325.    SendByte(suba);            //發(fā)送器件子地址
  326.      if(ack==0)return(0);

  328.      SendByte(*s);            //發(fā)送數(shù)據(jù)
  329.        if(ack==0)return(0);
  330.      Stop_I2c();                  //結(jié)束總線
  331.      DelayMs(1);               //必須延時(shí)等待芯片內(nèi)部自動(dòng)處理數(shù)據(jù)完畢
  332.          s++;
  333.          suba++;
  334.     }
  335.   return(1);
  336. }
  337. /*----------------------------------------------------------------
  338.                     向有子地址器件讀取多字節(jié)數(shù)據(jù)函數(shù)               
  339. 函數(shù)原型: bit  ISendStr(unsigned char sla,unsigned char suba,ucahr *s,unsigned char no);  
  340. 功能:     從啟動(dòng)總線到發(fā)送地址，子地址,讀數(shù)據(jù)，結(jié)束總線的全過(guò)程,從器件
  341.           地址sla，子地址suba，讀出的內(nèi)容放入s指向的存儲(chǔ)區(qū)，讀no個(gè)字節(jié)。
  342.            如果返回1表示操作成功，否則操作有誤。
  343. 注意：    使用前必須已結(jié)束總線。
  344. ---------------------------------------------------------------
  345. bit IRcvStr(unsigned char sla,unsigned char suba,unsigned char *s,unsigned char no)
  346. {
  347.    unsigned char i;

  349.    Start_I2c();               //啟動(dòng)總線
  350.    SendByte(sla);             //發(fā)送器件地址
  351.      if(ack==0)return(0);
  352.    SendByte(suba);            //發(fā)送器件子地址
  353.      if(ack==0)return(0);

  355.    Start_I2c();
  356.    SendByte(sla+1);
  357.       if(ack==0)return(0);

  359.   for(i=0;i<no-1;i++)
  360.     {
  361.      *s=RcvByte();              //發(fā)送數(shù)據(jù)
  362.       Ack_I2c();                //發(fā)送就答位
  363.      s++;
  364.     }
  365.    *s=RcvByte();
  366.     NoAck_I2c();                 //發(fā)送非應(yīng)位
  367.     Stop_I2c();                    //結(jié)束總線
  368.   return(1);
  369. }

  371. /*------------------------------------------------
  372.                    主函數(shù)
  373. ------------------------------------------------
  374. main()
  375. {
  376. //bit flag;
  377. unsigned char i;
  378. DelayMs(6000);
  379. ISendStr(0xae,80,dat,5);            //寫(xiě)入24c02
  380. DelayMs(10);                          //寫(xiě)入后必須延時(shí)等待24c02內(nèi)部
  381.                                        //燒錄數(shù)據(jù)處理完畢方可繼續(xù)其他操作
  382. IRcvStr(0xae,80,dat1,5);             //從24c02讀出數(shù)據(jù)
  383. while(1)
  384.      {

  386.            for(i=0;i<5;i++)              //查表
  387.              {
  388.                  DelayMs(2000);
  389.          P1=dat1[i];
  390.                  }
  391.          }
  392. }  */

  394. /*****************************************************
  395. ******************************************************
  396. **********************12864部分***********************
  397. ******************************************************
  398. *****************************************************/
  399. sbit rs=P3^7;
  400. sbit rw=P3^6;
  401. sbit en=P3^5;
  402. sbit psb=P3^4;
  403. sbit rst=P3^3;

  405. uchar key1=1,key2=1,key3=1,key4=1;

  407. void checkBusy(void)   //判忙
  408. {
  409. rs=0;
  410. rw=1;
  411. en=1;
  412. dataPort=0xff;
  413. while(dataPort & 0x80);
  414. en=0;
  415. }

  417. void writeCommand(unsigned char cmd)   //寫(xiě)命令
  418. {
  419. checkBusy();
  420. rs=0;
  421. rw=0;
  422. en=1;
  423. dataPort=cmd;
  424. _nop_();
  425. en=0;
  426. }

  428. void writeData(unsigned char adata)          //寫(xiě)數(shù)據(jù)
  429. {
  430. checkBusy();
  431. rs=1;
  432. rw=0;
  433. en=1;
  434. dataPort=adata;
  435. _nop_();
  436. en=0;
  437. }

  439. unsigned char readData(void)        //讀數(shù)據(jù)
  440. {
  441. unsigned char RData;
  442. dataPort=0xff;
  443. checkBusy();
  444. rs=1;
  445. rw=1;
  446. en=0;
  447. en=1;
  448. RData=dataPort;
  449. en=0;
  450. return RData;
  451. }       

  453. void ClrGDRAM(void)          //顯示用戶(hù)自定義字符
  454. {
  455.         unsigned char x,y;
  456.         for(y=0;y<64;y++)
  457.             for(x=0;x<16;x++)
  458.             {
  459.                         writeCommand(0x34);
  460.             writeCommand(y+0x80);     //行地址  
  461.             writeCommand(x+0x80);     //列地址  
  462.             writeCommand(0x30);
  463.             writeData(0x00);
  464.             writeData(0x00);
  465.         }
  466.         //writeCommand(0x30);
  467. }

  469. void LcmInit(void)                        //12864初始化
  470. {
  471. writeCommand(0x30);
  472. DelayMs(50);
  473. writeCommand(0x01);
  474. DelayMs(50);
  475. writeCommand(0x06);
  476. DelayMs(50);
  477. writeCommand(0x0c);
  478. ClrGDRAM();
  479. psb=1;
  480. }

  482. /* 清屏*/
  483. void ClrScreen()
  484. {
  485.    writeCommand(0x01);
  486.    DelayMs(15);
  487. }
  488.           
  489. /*畫(huà)點(diǎn)  打點(diǎn)位置(x0,y0);color=1,點(diǎn)亮；color=0,擦除*/
  490. void drawPoint(unsigned char x,unsigned char y,unsigned char color)
  491. {
  492. unsigned char row,collum,cbite;
  493. unsigned char tempH,tempL;
  494. writeCommand(0x34);
  495. writeCommand(0x36);
  496. collum=x>>4;
  497. cbite=x&0x0f;
  498. if(y<32)
  499.         row=y;
  500. else
  501.         {row=y-32;
  502.         collum+=8;
  503.         }
  504. writeCommand(0x80+row);
  505. writeCommand(0x80+collum);
  506. readData();
  507. tempH=readData();
  508. tempL=readData();
  509. writeCommand(0x80+row);
  510. writeCommand(0x80+collum);
  511. if (color)
  512. {
  513.          if(cbite<8)
  514.          {
  515.          tempH|=(1<<(7-cbite));
  516.          }
  517.          else
  518.          {
  519.          tempL|=(1<<(15-cbite));
  520.          }
  521. }
  522. else
  523. {
  524.            if(cbite<8)
  525.          {
  526.          tempH&=~(1<<(7-cbite));
  527.          }
  528.          else
  529.          {
  530.          tempL&=~(1<<(15-cbite));
  531.          }
  532. }
  533. writeData(tempH);
  534. writeData(tempL);
  535. writeCommand(0x30);
  536. }

  538. /**3X3個(gè)點(diǎn)合為一個(gè)**/
  539. void drawPoint_3(unsigned char x,unsigned char y, unsigned char color)   
  540. {
  541.   drawPoint(x,  y,  color);
  542.   drawPoint(x+1,y,  color);
  543.   drawPoint(x-1,y,  color);
  544.   drawPoint(x+1,y-1,color);
  545.   drawPoint(x,  y-1,color);
  546.   drawPoint(x-1,y-1,color);
  547.   drawPoint(x-1,y+1,color);
  548.   drawPoint(x,  y+1,color);
  549.   drawPoint(x+1,y+1,color);
  550.    
  551. }

  553. void QCRAM()  //清楚RAM
  554. {
  555.    uchar x,y;
  556.    uchar color=0;
  557.    for(x=0;x<=128;x++)
  558.      for(y=0;y<=80;y++)
  559.            drawPoint(x,y,color);
  560.           

  562. }

  564. #define SNAKE_Max_Long 20   //最大長(zhǎng)度
  565. struct
  566. {
  567.         uchar X[SNAKE_Max_Long];
  568.         uchar Y[SNAKE_Max_Long];
  569.         uchar Long;   
  570. }Snake;        //小車(chē)結(jié)構(gòu)體

  572. void Init_SNAKE(void)   
  573. {
  574.         uchar sum;
  575.         Snake.Long=2;                    //定義初始化小車(chē)的長(zhǎng)度
  576.         for(sum=0;sum<Snake.Long;sum++)        //將小車(chē)給賦值
  577.         {
  578.                 Snake.X[sum]=sum+20;
  579.                 Snake.Y[sum]=20;
  580.         }                                                       
  581.         for(sum=0;sum<Snake.Long;sum++)        //將小車(chē)給畫(huà)出來(lái)
  582.         {
  583.                 drawPoint_3(Snake.X[sum],Snake.Y[sum],1);
  584.         }                                                       
  585. }

  587. void keyscan()          //轉(zhuǎn)彎?rùn)z測(cè)
  588. {
  589.   if(!key1||!key2||!key3||!key4)
  590.   {
  591.     Run_SNAKE();
  592.            if(key1==0)
  593.                 {
  594.                           key1=1;
  595.                           a1=0;
  596.                           a2=0;
  597.                           a3=0;
  598.                   a4=1;                         
  599.                 }       
  600.         if(key2==0)
  601.                 {
  602.                       key2=1;
  603.                           a1=1;
  604.                           a2=0;
  605.                           a3=0;
  606.                           a4=0;
  607.                 }       
  608.         if(key3==0)
  609.                 {
  610.                           key3=1;
  611.                           a1=0;
  612.                           a2=1;
  613.                           a3=0;
  614.                           a4=0;
  615.                 }               
  616.         if(key4==0)
  617.                 {
  618.                           key4=1;
  619.                           a1=0;
  620.                           a2=0;
  621.                           a3=1;
  622.                           a4=0;
  623.                 }       
  624.    }       
  625. }       

  627. void Run_SNAKE(void)   //小車(chē)運(yùn)動(dòng)方向
  628. {
  629.         uchar sum=0;
  630.         /***小車(chē)的運(yùn)動(dòng)方向**/
  631.                         if(a1==1)
  632.                         {
  633.                            if(b1==1)
  634.                                 {
  635.                                            for(sum=0;sum<Snake.Long-1;sum++) // 向右 //小車(chē)身都是它前一段的小車(chē)身的位置
  636.                                 {
  637.                                      Snake.X[sum]=Snake.X[sum+1];
  638.                                      Snake.Y[sum]=Snake.Y[sum+1];
  639.                             }
  640.                
  641.                                 Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]+0;
  642.                                 Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]+1; //小車(chē)頭向你要求的方向移動(dòng)
  643.                                         }
  644.                                 if(b2==1)
  645.                                     {
  646.                                                 for(sum=0;sum<Snake.Long-1;sum++) //向左  //小車(chē)身都是它前一段的小車(chē)身的位置
  647.                                {
  648.                                      Snake.X[sum]=Snake.X[sum+1];
  649.                                  Snake.Y[sum]=Snake.Y[sum+1];
  650.                                }
  651.                
  652.                                Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]+0;
  653.                                Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]-1; //小車(chē)頭向你要求的方向移動(dòng)       
  654.                                         }
  655.                                  if(b3==1)
  656.                                     {
  657.                                                         for(sum=0;sum<Snake.Long-1;sum++)  //  向下  //小車(chē)身都是它前一段的小車(chē)身的位置
  658.                            {
  659.                                      Snake.X[sum]=Snake.X[sum+1];
  660.                                      Snake.Y[sum]=Snake.Y[sum+1];
  661.                                }
  662.                
  663.                                Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]-1;
  664.                                Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]+0; //小車(chē)頭向你要求的方向移動(dòng)
  665.                                         }
  666.                                  if(b4==1)
  667.                                     {
  668.                                                  for(sum=0;sum<Snake.Long-1;sum++)  //  向上  //小車(chē)身都是它前一段的小車(chē)身的位置
  669.                                {
  670.                                       Snake.X[sum]=Snake.X[sum+1];
  671.                                       Snake.Y[sum]=Snake.Y[sum+1];
  672.                                }

  674.                                Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]+1;
  675.                                Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]+0; //小車(chē)頭向你要求的方向移動(dòng)
  676.                                         }
  677.                                        
  678.                          if(!key1||!key2||!key3||!key4)
  679.                             {
  680.                           if(b1==1)
  681.                            {
  682.                                      b1=0;
  683.                                   b2=1;
  684.                                   b3=0;
  685.                                   b4=0;
  686.                            }
  687.                           else if(b2==1)
  688.                            {
  689.                                      b1=1;
  690.                                   b2=0;
  691.                                   b3=0;
  692.                                   b4=0;
  693.                            }
  694.                           else if(b3==1)
  695.                            {
  696.                                      b1=0;
  697.                                   b2=0;
  698.                                   b3=0;
  699.                                   b4=1;
  700.                            }
  701.                           else if(b4==1)
  702.                            {
  703.                                      b1=0;
  704.                                   b2=0;
  705.                                   b3=1;
  706.                                   b4=0;
  707.                            }   
  708.                             }
  709.                         }
  710.        

  712.                         if(a2==1)
  713.                         {
  714.                           if(b1==1)
  715.                                 {
  716.                                                  for(sum=0;sum<Snake.Long-1;sum++)  //  向下   //小車(chē)身都是它前一段的小車(chē)身的位置
  717.                            {
  718.                                      Snake.X[sum]=Snake.X[sum+1];
  719.                                      Snake.Y[sum]=Snake.Y[sum+1];
  720.                                }
  721.                
  722.                                Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]-1;
  723.                                Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]+0; //小車(chē)頭向你要求的方向移動(dòng)
  724.                                         }
  725.                                 if(b2==1)
  726.                                     {
  727.                                                  for(sum=0;sum<Snake.Long-1;sum++)  //  向上  //小車(chē)身都是它前一段的小車(chē)身的位置
  728.                                {
  729.                                       Snake.X[sum]=Snake.X[sum+1];
  730.                                       Snake.Y[sum]=Snake.Y[sum+1];
  731.                                }

  733.                                Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]+1;
  734.                                Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]+0; //小車(chē)頭向你要求的方向移動(dòng)
  735.                                         }
  736.                                  if(b3==1)
  737.                                     {                          
  738.                                                 for(sum=0;sum<Snake.Long-1;sum++) //向左   //小車(chē)身都是它前一段的小車(chē)身的位置
  739.                                {
  740.                                      Snake.X[sum]=Snake.X[sum+1];
  741.                                  Snake.Y[sum]=Snake.Y[sum+1];
  742.                                }
  743.                
  744.                                Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]+0;
  745.                                Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]-1; //小車(chē)頭向你要求的方向移動(dòng)
  746.                                         }
  747.                                   if(b4==1)
  748.                                     {
  749.                                                 for(sum=0;sum<Snake.Long-1;sum++) // 向右  //小車(chē)身都是它前一段的小車(chē)身的位置
  750.                                 {
  751.                                      Snake.X[sum]=Snake.X[sum+1];
  752.                                      Snake.Y[sum]=Snake.Y[sum+1];
  753.                             }
  754.                
  755.                                 Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]+0;
  756.                                 Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]+1; //小車(chē)頭向你要求的方向移動(dòng)
  757.                                         }                 
  758.                       if(!key1||!key2||!key3||!key4)
  759.                             {
  760.                                         if(b1==1)
  761.                            {
  762.                                      b1=0;
  763.                                   b2=0;
  764.                                   b3=0;
  765.                                   b4=1;
  766.                            }
  767.                           else if(b2==1)
  768.                            {
  769.                                      b1=0;
  770.                                   b2=0;
  771.                                   b3=1;
  772.                                   b4=0;
  773.                            }
  774.                           else if(b3==1)
  775.                            {
  776.                                      b1=1;
  777.                                   b2=0;
  778.                                   b3=0;
  779.                                   b4=0;
  780.                            }
  781.                           else if(b4==1)
  782.                            {
  783.                                      b1=0;
  784.                                   b2=1;
  785.                                   b3=0;
  786.                                   b4=0;
  787.                            }   
  788.                             }
  789.                         }

  791.                  
  792.                         if(a3==1)
  793.                         {
  794.                           if(b1==1)
  795.                                 {
  796.                                             for(sum=0;sum<Snake.Long-1;sum++)  //  向上 //小車(chē)身都是它前一段的小車(chē)身的位置
  797.                                {
  798.                                       Snake.X[sum]=Snake.X[sum+1];
  799.                                       Snake.Y[sum]=Snake.Y[sum+1];
  800.                                }

  802.                                Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]+1;
  803.                                Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]+0; //小車(chē)頭向你要求的方向移動(dòng)
  804.                                         }
  805.                                 if(b2==1)
  806.                                     {
  807.                                                         for(sum=0;sum<Snake.Long-1;sum++)  //  向下 //小車(chē)身都是它前一段的小車(chē)身的位置
  808.                            {
  809.                                      Snake.X[sum]=Snake.X[sum+1];
  810.                                      Snake.Y[sum]=Snake.Y[sum+1];
  811.                                }
  812.                
  813.                                Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]-1;
  814.                                Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]+0; //小車(chē)頭向你要求的方向移動(dòng)
  815.                                         }
  816.                                  if(b3==1)
  817.                                     {
  818.                                            for(sum=0;sum<Snake.Long-1;sum++) // 向右   //小車(chē)身都是它前一段的小車(chē)身的位置
  819.                                 {
  820.                                      Snake.X[sum]=Snake.X[sum+1];
  821.                                      Snake.Y[sum]=Snake.Y[sum+1];
  822.                             }
  823.                
  824.                                 Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]+0;
  825.                                 Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]+1; //小車(chē)頭向你要求的方向移動(dòng)
  826.                                         }
  827.                                  if(b4==1)
  828.                                     {
  829.                                            for(sum=0;sum<Snake.Long-1;sum++) //向左  //小車(chē)身都是它前一段的小車(chē)身的位置
  830.                                {
  831.                                      Snake.X[sum]=Snake.X[sum+1];
  832.                                  Snake.Y[sum]=Snake.Y[sum+1];
  833.                                }
  834.                
  835.                                Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]+0;
  836.                                Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]-1; //小車(chē)頭向你要求的方向移動(dòng)
  837.                                         }                 
  838.                          if(!key1||!key2||!key3||!key4)
  839.                             {
  840.                                         if(b1==1)
  841.                            {
  842.                                      b1=0;
  843.                                   b2=0;
  844.                                   b3=1;
  845.                                   b4=0;
  846.                            }
  847.                           else if(b2==1)
  848.                            {
  849.                                      b1=0;
  850.                                   b2=0;
  851.                                   b3=0;
  852.                                   b4=1;
  853.                            }
  854.                           else if(b3==1)
  855.                            {
  856.                                      b1=0;
  857.                                   b2=1;
  858.                                   b3=0;
  859.                                   b4=0;
  860.                            }
  861.                           else if(b4==1)
  862.                            {
  863.                                      b1=1;
  864.                                   b2=0;
  865.                                   b3=0;
  866.                                   b4=0;
  867.                            }   
  868.                             }
  869.                         }
  870.                

  872.                         if(a4==1)
  873.                         {
  874.                             if(b1==1)
  875.                                 {
  876.                                            for(sum=0;sum<Snake.Long-1;sum++) //向左  //小車(chē)身都是它前一段的小車(chē)身的位置
  877.                                {
  878.                                      Snake.X[sum]=Snake.X[sum+1];
  879.                                  Snake.Y[sum]=Snake.Y[sum+1];
  880.                                }
  881.                
  882.                                Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]+0;
  883.                                Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]-1; //小車(chē)頭向你要求的方向移動(dòng)
  884.                                         }
  885.                                 if(b2==1)
  886.                                     {
  887.                                             for(sum=0;sum<Snake.Long-1;sum++) // 向右  //小車(chē)身都是它前一段的小車(chē)身的位置
  888.                                 {
  889.                                      Snake.X[sum]=Snake.X[sum+1];
  890.                                      Snake.Y[sum]=Snake.Y[sum+1];
  891.                             }
  892.                
  893.                                 Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]+0;
  894.                                 Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]+1; //小車(chē)頭向你要求的方向移動(dòng)
  895.                                         }
  896.                                  if(b3==1)
  897.                                     {
  898.                                            for(sum=0;sum<Snake.Long-1;sum++)  //  向上 //小車(chē)身都是它前一段的小車(chē)身的位置
  899.                                {
  900.                                       Snake.X[sum]=Snake.X[sum+1];
  901.                                       Snake.Y[sum]=Snake.Y[sum+1];
  902.                                }

  904.                                Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]+1;
  905.                                Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]+0; //小車(chē)頭向你要求的方向移動(dòng)

  907.                                         }
  908.                                  if(b4==1)
  909.                                     {
  910.                                                 for(sum=0;sum<Snake.Long-1;sum++)  //  向下  //小車(chē)身都是它前一段的小車(chē)身的位置
  911.                            {
  912.                                      Snake.X[sum]=Snake.X[sum+1];
  913.                                      Snake.Y[sum]=Snake.Y[sum+1];
  914.                                }
  915.                
  916.                                Snake.X[Snake.Long-1]=Snake.X[Snake.Long-2]-1;
  917.                                Snake.Y[Snake.Long-1]=Snake.Y[Snake.Long-2]+0; //小車(chē)頭向你要求的方向移動(dòng)
  918.                                         }
  919.                          if(!key1||!key2||!key3||!key4)
  920.                             {
  921.                                         if(b1==1)
  922.                            {
  923.                                      b1=1;
  924.                                   b2=0;
  925.                                   b3=0;
  926.                                   b4=0;
  927.                            }
  928.                           else if(b2==1)
  929.                            {
  930.                                      b1=0;
  931.                                   b2=1;
  932.                                   b3=0;
  933.                                   b4=0;
  934.                            }
  935.                           else if(b3==1)
  936.                            {
  937.                                      b1=0;
  938.                                   b2=0;
  939.                                   b3=1;
  940.                                   b4=0;
  941.                            }
  942.                           else if(b4==1)
  943.                            {
  944.                                      b1=0;
  945.                                   b2=0;
  946.                                   b3=0;
  947.                                   b4=1;
  948.                            }   
  949.                             }
  950.                         }       
  951.        
  952. }       

  954. /*******************************************
  955. ********************************************
  956. *************小車(chē)部分***********************
  957. ********************************************
  958. ********************************************/

  960. /********外部中斷定義*************/
  961. void ini()
  962. {
  963.    //EA=1;          //全局中斷開(kāi)
  964.    EX0=0;         //外部中斷0開(kāi)
  965.    IT0=1;         //邊緣觸發(fā)
  966.    //EX1=0;         //外部中斷1開(kāi)
  967.    //IT1=1;         //電平觸發(fā)
  968. }


  971. /*****外部中斷0函數(shù)*****/
  972. void ini_t0() interrupt 0
  973. {
  974.         bianma1--;
  975. }

  977. /********pwm中斷調(diào)速定義*************/
  978. void pwm()
  979. {  
  980.    TMOD=0x01; /* 設(shè)定T0的工作模式為2 */  
  981.    TH0=(65536-100)/256; /* 裝入定時(shí)器的初值 晶振20MHZ 每100us中斷一次10次（即1MS）為1個(gè)PWM周期*/  
  982.    TL0=(65536-100)%256;  
  983.    EA=1; /* 開(kāi)總中斷 */  
  984.    ET0=1; /* 定時(shí)器0允許中斷 */  
  985.    TR0=1; /* 啟動(dòng)定時(shí)器0 */  
  986.    PT0=1;//高優(yōu)先級(jí)
  987. }


  990. /*****定時(shí)中斷函數(shù)2*****/
  991. void timer0() interrupt 1 /* T0中斷服務(wù)程序 */  
  992. {  
  993.        i++;
  994.        j++;
  995.        if(i<=m1) en1=1;
  996.           else en1=0;
  997.        if(j<=m2) en2=1;
  998.           else en2=0;
  999.            if(i==100)  {i=0;}
  1000.        if(j==100)  {j=0;}
  1001.        TH0=(65536-100)/256;
  1002.        TL0=(65536-100)%256;
  1003. }  

  1005. //岔路口 轉(zhuǎn)向記錄
  1006. void crossing(uchar save)
  1007. {
  1008.     if(save=='A'){strcat(road,"A");}
  1009.     if(save=='B'){strcat(road,"B");}
  1010.     if(save=='R'){strcat(road,"R");}
  1011.     if(save=='L'){strcat(road,"L");}
  1012.         if(save=='D'){strcat(road,"D");}
  1013.     if(save=='0'){strcat(road,"\0");}
  1014. }                

  1016. //記憶路徑播音
  1017. void boyin(uchar save)
  1018. {
  1019.     if(save=='A'){stop();ISD1420p(3,1200);}
  1020.     if(save=='B'){stop();ISD1420p(2,1200);}
  1021.     if(save=='R'){stop();ISD1420p(1,1200);}
  1022.     if(save=='L'){stop();ISD1420p(0,1200);}
  1023.         if(save=='D'){stop();while(!markkey)  {logokey=0;DelayMs(3000) ;logokey=1;guo=0;}ISD1420p(2,1200);}
  1024. }

  1026. /*// 存入24c02
  1027. void cunru24c02()
  1028. {
  1029.    uchar sum=0;
  1030.    while(*p)
  1031.     {
  1032.            if(*p=='A')  cun24c02[sum]=0x01;
  1033.        if(*p=='B')  cun24c02[sum]=0x02;
  1034.        if(*p=='R')        cun24c02[sum]=0x03;
  1035.        if(*p=='L')        cun24c02[sum]=0x04;
  1036.            p++;
  1037.            sum++;
  1038.         }
  1039.         cun24c02[sum]=0;
  1040.         EA=0;//關(guān)掉中斷       
  1041.         ISendStr(0xae,80,cun24c02,15);            //寫(xiě)入24c02
  1042.     DelayMs(10);                          //寫(xiě)入后必須延時(shí)等待24c02內(nèi)部
  1043.         EA=1;//開(kāi)啟中斷
  1044. }

  1046. // 取出24c02
  1047. void quchu24c02()
  1048. {
  1049.    uchar sum=0;
  1050.    while(cun24c02[sum])
  1051.     {
  1052.            if(cun24c02[sum]==0x01)  strcat(p,"A");
  1053.        if(cun24c02[sum]==0x02)  strcat(p,"B");
  1054.        if(cun24c02[sum]==0x03)        strcat(p,"R");
  1055.        if(cun24c02[sum]==0x04)        strcat(p,"L");
  1056.            sum++;
  1057.         }
  1058.     strcat(p,"\0");
  1059.         EA=0;//關(guān)掉中斷       
  1060.         IRcvStr(0xae,80,p,15);             //從24c02讀出數(shù)據(jù)
  1061.         EA=1;//開(kāi)啟中斷
  1062. }        */


  1065. /******************************************************
  1066. *******************************************************
  1067. ************ISD1420p語(yǔ)音播報(bào)***************************
  1068. *******************************************************
  1069. *******************************************************/
  1070. sbit playe=P3^0;
  1071. uchar code temp[8]={0x00,0x10,0x20,0x30,0x40,0x50,0x70,0x90};
  1072. /* 0x00//左轉(zhuǎn)                     延時(shí)400Ms
  1073.     0x10//右轉(zhuǎn)                             延時(shí)400Ms
  1074.     0x20//掉頭                       延時(shí)400Ms
  1075.         0x30//直走                       延時(shí)400Ms
  1076.     0x40//到達(dá)終點(diǎn)                    延時(shí)800Ms  
  1077.     0x50//最優(yōu)路徑計(jì)算完畢  延時(shí)1600Ms
  1078.     0x70//最優(yōu)路徑行駛             延時(shí)1600Ms
  1079.         0x90//智能迷宮小車(chē)            延時(shí)1600Ms         */
  1080. void ISD1420p(uchar t1,uint t2)
  1081. {                                                                                                                   
  1082.                 playe=1;
  1083.         write595(temp[t1]);
  1084.         playe=0;
  1085.         DelayMs(t2);
  1086.             DelayMs(t2);  
  1087.         playe=1;  
  1088.         /*        P1=0;
  1089.         playe=1;
  1090.         P1=temp[t1];
  1091.         playe=0;
  1092.         DelayMs(t2);
  1093.             DelayMs(t2);
  1094.         P1=0;
  1095.         playe=1;   */
  1096. }

  1098.    
  1099. /********************************************
  1100. *********************************************
  1101. *****************最優(yōu)路線計(jì)算****************
  1102. *********************************************
  1103. *********************************************/
  1104. int pq(char s1[],char s2[],char ee)
  1105. {
  1106.     int opo=0;
  1107.     int w=0;
  1108.     int i;
  1109.     int k;
  1110.     int j;
  1111.     for(i=0;s1[i];i++)
  1112.     {
  1113.       j=i;
  1114.       for(k=0;s2[k];k++)
  1115.         if(s1[j]&&s1[j]==s2[k])j++;
  1116.            else break;
  1117.       if(!s2[k])
  1118.       {   
  1119.         opo=i;
  1120.          w++;
  1121.         if(ee==1)break;
  1122.       }
  1123. }
  1124. if(w==1)return opo;
  1125. else return -1;
  1126. }
  1127. char* str_text(){

  1129. int j,i,k,f=1,f2=1;//i用于計(jì)數(shù)  f內(nèi)層標(biāo)記 f2外層標(biāo)記     
  1130. do{
  1131. for(i=0;i<9;i++,f=1)
  1132. {
  1133.   do
  1134.   {
  1135.    j=pq(road,aa[i],1);  //選出匹配字符串下標(biāo)
  1136.        if(j==-1)break;
  1137.     else  
  1138.     {   road[j]=a[i][0];
  1139.      while(road[j+3]){road[j+1]=road[j+3];j++;}
  1140.      road[j+1]='\0';
  1141.     }  
  1142.   }while(1);//判斷本次匹配替換是否結(jié)束，如果否 繼續(xù)匹配并替換

  1144. }  //for循環(huán)結(jié)束

  1146. //*******校驗(yàn)
  1147. for(k=0;k<9;k++)
  1148. {
  1149.   j=pq(road,aa[k],1);
  1150.   if(j!=-1)
  1151.   {
  1152.    f2=1;break;  //判斷是否仍然有匹配項(xiàng)目，如果有重新執(zhí)行內(nèi)層do~while語(yǔ)句
  1153.         }else{f2=0;}
  1154. }//校驗(yàn)for結(jié)束

  1156. }while(f2==1); //外層do while 用于校驗(yàn)

  1158. return road;  //road首地址
  1159.      //printf("%s\n",turn2);scanf("%s",c);
  1160. }

  1162. /******************************************************
  1163. *******************************************************
  1164. *************小車(chē)路徑處理******************************
  1165. *******************************************************
  1166. *******************************************************/

  1168. /******************路口誤差排除函數(shù)********************/
  1169. uchar you=0;


  1172. ………完整代碼請(qǐng)下載附件………

復(fù)制代碼



作者: 騰飛的龍    時(shí)間: 2017-11-4 13:59
謝謝樓主的分享！學(xué)習(xí)啦。電路圖是用什么軟件打開(kāi)？
作者: yuguoyu123456    時(shí)間: 2018-4-15 15:26
有最短路徑嗎
作者: 請(qǐng)問(wèn)同樣    時(shí)間: 2018-5-20 18:27
一千多行代碼，大哥，太六了
作者: mslong    時(shí)間: 2018-5-20 18:58

一千多行代碼，大哥，太六了
作者: 862263539    時(shí)間: 2018-5-30 18:51
謝謝分享
作者: 2089235932    時(shí)間: 2018-12-1 17:27
謝謝樓主的分享！學(xué)習(xí)啦。謝謝！
作者: biohazard123    時(shí)間: 2019-6-25 21:02
騰飛的龍 發(fā)表于 2017-11-4 13:59
謝謝樓主的分享！學(xué)習(xí)啦。電路圖是用什么軟件打開(kāi)？

你是水軍吧
作者: 13631784213    時(shí)間: 2019-11-4 18:43
ad打開(kāi)不能編輯
作者: 呀11    時(shí)間: 2019-11-18 22:59
太厲害了
作者: youngee    時(shí)間: 2019-12-9 11:46
請(qǐng)問(wèn)同樣 發(fā)表于 2018-5-20 18:27
一千多行代碼，大哥，太六了

他這個(gè)有沒(méi)有遍歷和迷宮的算法
作者: dingangkeji    時(shí)間: 2019-12-9 15:34
這也太專(zhuān)業(yè)了些。。。。。。
作者: XIE780102636    時(shí)間: 2020-1-8 09:56
一千多行代碼，大哥，太六了
作者: 李春雨    時(shí)間: 2020-2-7 21:45

謝謝樓主的分享！學(xué)習(xí)啦
作者: yu霈    時(shí)間: 2020-2-17 02:18
謝謝分享
作者: hgfyfuy    時(shí)間: 2020-12-3 18:08
除了厲害還是厲害



歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1