標題: 51單片機循跡小車的程序錯誤,求解答 [打印本頁]
作者: TTF_JQ_1    時間: 2024-4-10 13:27
標題: 51單片機循跡小車的程序錯誤,求解答
以下是我參照論壇內大佬的代碼寫的單片機代碼，在仿真上出現了以下錯誤
1.在沒有信號時，其不能完全停止。motor仍顯示在轉動，但較為緩慢。（void stop）不知道是仿真的問題還是程序的問題。（全部給的反轉，速度全部為0）
2.我寫的六個運動方式，分別為：停止（stop），直走zhizou）、左大轉（dazhuan1）、右大轉(dazhuan2)、左微調(weitiao1)、右微調(weitiao2)
   現在的問題是除左大轉外，其余的運轉方式都成功，左大轉的左電機管腳出出現閃爍，疑似信號沖突，但我沒有找到沖突的點在哪？
3.我嘗試過將左大轉的正反轉函數將0換成1，結果其運行正常，求解
請求各位大佬的幫助，搞了幾天，真的看不到沖突的點在哪里.(還有，模擬紅外傳感器的按鈕松開表示有信號1，按下默認為0)
程序寫的很亂，但是希望各位大佬能耐心看完，指出問題所在。急需。
在此，感激不盡。祝生活愉快，萬事如意。
  1. #include<reg51.h>
  2. #define uchar unsigned char
  3. #define uint unsigned int

  5. extern void Motor_Left_Q(bit ReverOrCoro, unsigned char DutyCycle); //????????
  6. extern void Motor_Left_H(bit ReverOrCoro, unsigned char DutyCycle);
  7. extern void Motor_Right_Q(bit ReverOrCoro, unsigned char DutyCycle); //????????
  8. extern void Motor_Right_H(bit ReverOrCoro, unsigned char DutyCycle);
  9. extern void stop(void);

  11. void Timer0Config(); //        ?????0

  13. void zhizou();
  14. void dazhuan1();
  15. void dazhuan2();
  16. void weitiao1();
  17. void weitiao2();


  20. sbit ENA1 = P1^5; //???????                                   
  21. sbit ENB1= P1^6;
  22. sbit ENA2 = P2^5; //???????                                   
  23. sbit ENB2= P2^6;
  24. sbit led = P2^4;//???
  25. uchar a;

  27. uchar Infrared; //??P0?????   ?????
  28. void scan(void);
  29. sbit inputL1=P0^0;   //?1
  30. sbit inputL2=P0^1;    //?2
  31. sbit inputR1=P0^2;      //?2
  32. sbit inputR2=P0^3;      //?1

  34. void main()
  35. {
  36.         Timer0Config();
  37.         ENA1 = 1;
  38.     ENB1 = 1;
  39.     ENA2 = 1;
  40.     ENB2 = 1;
  41.     while(1)
  42.         {               
  43.          scan();
  44.         }
  45. }


  48. void scan()           
  49. {
  50.           if(inputL1==0&&inputR1==0&&inputL2==0&&inputR2==0)        //0000
  51.           {
  52.                         stop();
  53.            }
  54.           if(inputL1==1&&inputL2==0&&inputR1==0&&inputR2==0) //1000
  55.           {
  56.                         dazhuan1();
  57.            }
  58.           if(inputL1==0&&inputL2==1&&inputR1==0&&inputR2==0)  //0100
  59.           {
  60.                         weitiao1();
  61.            }
  62.             if(inputL1==0&&inputL2==0&&inputR1==1&&inputR2==0) //0010
  63.           {
  64.                         weitiao2();
  65.            }
  66.       if(inputL1==0&&inputL2==0&&inputR1==0&&inputR2==1)        //0001
  67.           {
  68.                         dazhuan2() ;
  69.            }
  70.        else
  71.       {
  72.            zhizou();
  73.       }
  74. }


  77. void zhizou()
  78. {
  79.      Infrared = inputL1==1&&inputL2==1&&inputR1==1&&inputR2==1;
  80.          Motor_Left_Q(1, 100), Motor_Right_Q(1, 100);
  81.      Motor_Left_H(1, 100), Motor_Right_H(1, 100);
  82.          
  83. }
  84. void dazhuan1()       //左大轉/    1000
  85. {
  86.             Motor_Left_Q(0, 200); Motor_Right_Q(1, 200);
  87.             Motor_Left_H(0, 200); Motor_Right_H(1, 200);
  88.       
  89.     }

  91.     void dazhuan2()    //右大轉/   0001
  92. {
  93.         
  94.                 Motor_Left_Q(1, 200); Motor_Right_Q(0, 200);
  95.         Motor_Left_H(1, 200); Motor_Right_H(0, 200);   
  96.      }
  97. void weitiao1()     //左微調/  0100
  98. {
  99.         
  100.                 Motor_Left_Q(1, 10); Motor_Right_Q(1, 100);
  101.         Motor_Left_H(1, 10); Motor_Right_H(1, 100);
  102.         Infrared = inputL1==0&&inputL2==1&&inputR1==0&&inputR2==0;
  103.                
  104. }


  107. void weitiao2()//右微調/   0010
  108. {

  110.                 Motor_Left_Q(1, 100); Motor_Right_Q(1, 10);
  111.         Motor_Left_H(1, 100); Motor_Right_H(1, 10);//60
  112.         Infrared = inputL1==0&&inputL2==0&&inputR1==1&&inputR2==0;
  113. }               

  115. void stop()
  116. {
  117.          Motor_Left_Q(1, 0), Motor_Right_Q(1, 0);
  118.      Motor_Left_H(1, 0), Motor_Right_H(1, 0);  
  119. }
  120. void Timer0Config()
  121. {
  122.         TMOD &= 0xF0;
  123.         TMOD |= 0x01;
  124.         TH0 = 0xFF;
  125.         TL0 = 0x7E;
  126.         EA = 1;
  127.         ET0 = 1;
  128.         TR0 = 1;
  129. }
復制代碼
  1. #include<reg51.h>

  3. sbit IN1 = P1^0; //定義左前電機控制引腳   
  4. sbit IN2 = P1^1; //                     
  5. sbit IN3 = P1^2; //定義左后電機控制引腳   
  6. sbit IN4 = P1^3; //                     
  7. sbit IN5 = P2^0; //定義右前電機控制引腳   
  8. sbit IN6 = P2^1; //                     
  9. sbit IN7 = P2^2; //定義右后電機控制引腳   
  10. sbit IN8 = P2^3; //                     

  12. void Motor_Left_Q(bit ReverOrCoro, unsigned char DutyCycle);  //左前邊電機控制函數
  13. void Motor_Right_Q(bit ReverOrCoro, unsigned char DutyCycle); //右前邊電機控制函數
  14. void Motor_Left_H(bit ReverOrCoro, unsigned char DutyCycle);  //左后邊電機控制函數
  15. void Motor_Right_H(bit ReverOrCoro, unsigned char DutyCycle); //右后邊電機控制函數

  17. unsigned char cnt = 0;

  19. void Motor_Left_Q(bit ReverOrCoro, unsigned char DutyCycle) //傳遞正反轉(1為正轉，0為反轉)、占空比參數    左前
  20. {
  21.         if(ReverOrCoro == 1)
  22.         {
  23.                 IN1 = 1;
  24.                 if(cnt <= DutyCycle)
  25.                 {
  26.                         IN2 = 0;
  27.                 }
  28.                 else
  29.                 {
  30.                         IN2 = 1;
  31.                 }
  32.         }
  33.         else
  34.         {
  35.                 IN2 = 1;
  36.                 if(cnt <= DutyCycle)
  37.                 {
  38.                         IN1 = 0;
  39.                 }
  40.                 else
  41.                 {
  42.                         IN1 = 1;
  43.                 }
  44.         }
  45. }

  47. void Motor_Left_H(bit ReverOrCoro, unsigned char DutyCycle) //傳遞正反轉(1為正轉，0為反轉)、占空比參數DutyCycle   左后
  48. {
  49.         if(ReverOrCoro == 1)
  50.         {
  51.                 IN3 = 1;
  52.                 if(cnt <= DutyCycle)
  53.                 {
  54.                         IN4 = 0;
  55.                 }
  56.                 else
  57.                 {
  58.                         IN4 = 1;
  59.                 }
  60.         }
  61.         else
  62.         {
  63.                 IN4 = 1;
  64.                 if(cnt <= DutyCycle)
  65.                 {
  66.                         IN3 = 0;
  67.                 }
  68.                 else
  69.                 {
  70.                         IN3 = 1;
  71.                 }
  72.         }
  73. }

  75. void Motor_Right_Q(bit ReverOrCoro, unsigned char DutyCycle) //傳遞正反轉(1為正轉，0為反轉)、占空比參數    右前
  76. {
  77.         if(ReverOrCoro == 1)
  78.         {
  79.                 IN5 = 1;
  80.                 if(cnt <= DutyCycle)
  81.                 {
  82.                         IN6 = 0;
  83.                 }
  84.                 else
  85.                 {
  86.                         IN6 = 1;
  87.                 }
  88.         }
  89.         else if(ReverOrCoro == 0)
  90.         {
  91.                 IN6 = 1;
  92.                 if(cnt <= DutyCycle)
  93.                 {
  94.                         IN5 = 0;
  95.                 }
  96.                 else
  97.                 {
  98.                         IN5 = 1;
  99.                 }
  100.         }
  101. }

  103. void Motor_Right_H(bit ReverOrCoro, unsigned char DutyCycle) //傳遞正反轉(1為正轉，0為反轉)、占空比參數    右后
  104. {
  105.         if(ReverOrCoro == 1)
  106.         {
  107.                 IN7 = 1;
  108.         IN8 = 0;
  109.                 /*if(cnt <= DutyCycle)
  110.                 {
  111.                         
  112.                 }
  113.                 else
  114.                 {
  115.                         IN8 = 1;
  116.                 }*/
  117.         }
  118.         else if(ReverOrCoro == 0)
  119.         {
  120.                 IN8 = 1;
  121.         IN7 = 0;
  122.                 /*if(cnt <= DutyCycle)
  123.                 {
  124.                         
  125.                 }
  126.                 else
  127.                 {
  128.                         IN7 = 1;
  129.                 }*/
  130.         }
  131. }
  132. void InterruptTimer0() interrupt 1  
  133. {
  134.         TH0 = 0xFF;
  135.         TL0 = 0x7E;
  136.         cnt++;
  137.         if(cnt >= 100)
  138.         {
  139.                 cnt = 0;
  140.         }
  141. }
復制代碼

motor，test.zip

25.55 KB, 下載次數: 4

仿真

程序測試.zip

106.07 KB, 下載次數: 4

其中的個人嘗試為原文件
作者: xiaoyao166ny    時間: 2024-4-11 09:00
硬件 連接有沒有問題
作者: lkc8210    時間: 2024-4-11 11:31
程序附件里只有keil的項目檔
沒有C檔H檔



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