找回密碼
 立即注冊(cè)

QQ登錄

只需一步，快速開(kāi)始

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

3路循跡STM32參考代碼

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:927279 發(fā)表于 2021-11-6 14:03 | 只看該作者 回帖獎(jiǎng)勵(lì) |倒序?yàn)g覽 |閱讀模式
發(fā)出來(lái)供大家參考學(xué)習(xí) 附循跡代碼

單片機(jī)源程序如下:
  1. //連接方式 ：請(qǐng)參考interface.h文件
  2. //部份源碼來(lái)源網(wǎng)絡(luò)
  3. #include "stm32f10x.h"
  4. #include "interface.h"
  5. #include "LCD1602.h"
  6. #include "IRCtrol.h"
  7. #include "motor.h"
  8. #include "uart.h"

  10. //全局變量定義
  11. unsigned int speed_count=0;//占空比計(jì)數(shù)器 50次一周期
  12. char front_left_speed_duty=SPEED_DUTY;
  13. char front_right_speed_duty=SPEED_DUTY;
  14. char behind_left_speed_duty=SPEED_DUTY;
  15. char behind_right_speed_duty=SPEED_DUTY;

  17. unsigned char tick_5ms = 0;//5ms計(jì)數(shù)器，作為主函數(shù)的基本周期
  18. unsigned char tick_1ms = 0;//1ms計(jì)數(shù)器，作為電機(jī)的基本計(jì)數(shù)器
  19. unsigned char tick_200ms = 0;//刷新顯示

  21. char ctrl_comm = COMM_STOP;//控制指令
  22. char ctrl_comm_last = COMM_STOP;//上一次的指令
  23. unsigned char continue_time=0;
  24. unsigned char bt_rec_flag=0;//藍(lán)牙控制標(biāo)志位

  26. //循跡，通過(guò)判斷三個(gè)光電對(duì)管的狀態(tài)來(lái)控制小車(chē)運(yùn)動(dòng)
  27. void SearchRun(void)
  28. {
  29.         //三路都檢測(cè)到
  30.         if(SEARCH_M_IO == BLACK_AREA && SEARCH_L_IO == BLACK_AREA && SEARCH_R_IO == BLACK_AREA)
  31.         {
  32.                 ctrl_comm = COMM_UP;
  33.                 return;
  34.         }
  35.        
  36.         if(SEARCH_R_IO == BLACK_AREA)//右
  37.         {
  38.                 ctrl_comm = COMM_RIGHT;
  39.         }
  40.         else if(SEARCH_L_IO == BLACK_AREA)//左
  41.         {
  42.                 ctrl_comm = COMM_LEFT;
  43.         }
  44.         else if(SEARCH_M_IO == BLACK_AREA)//中
  45.         {
  46.                 ctrl_comm = COMM_UP;
  47.         }
  48. }


  51. int main(void)
  52. {
  53.         delay_init();
  54.         GPIOCLKInit();
  55.         UserLEDInit();
  56.         LCD1602Init();
  57.         //IRCtrolInit();
  58.         TIM2_Init();
  59.         MotorInit();
  60.         ServoInit();
  61.        
  62.         RedRayInit();
  63.         //USART3Conf(9600);

  65. while(1)
  66. {         
  67.                          if(tick_5ms >= 5)
  68.                 {
  69.                         tick_5ms = 0;
  70.                         tick_200ms++;
  71.                         if(tick_200ms >= 40)
  72.                         {
  73.                                 tick_200ms = 0;
  74.                                 LEDToggle(LED_PIN);
  75.                         }
  76. //                        continue_time--;//200ms 無(wú)接收指令就停車(chē)
  77. //                        if(continue_time == 0)
  78. //                        {
  79. //                                continue_time = 1;
  80. //                                CarStop();
  81. //                        }
  82.                         //do something
  83.                         SearchRun();
  84.                         if(ctrl_comm_last != ctrl_comm)//指令發(fā)生變化
  85.                         {
  86.                                 ctrl_comm_last = ctrl_comm;
  87.                                 switch(ctrl_comm)
  88.                                 {
  89.                                         case COMM_UP:    CarGo();break;
  90.                                         case COMM_DOWN:  CarBack();break;
  91.                                         case COMM_LEFT:  CarLeft();break;
  92.                                         case COMM_RIGHT: CarRight();break;
  93.                                         case COMM_STOP:  CarStop();break;
  94.                                         default : break;
  95.                                 }
  96.                                 Delayms(10);//防抖
  97.                                 LCD1602WriteCommand(ctrl_comm);
  98.                         }
  99.                 }
  100.                
  101. }
  102. }
復(fù)制代碼

Keil代碼下載: 3路循跡STM32參考實(shí)驗(yàn).7z (180.74 KB, 下載次數(shù): 13)



評(píng)分

參與人數(shù) 1黑幣 +30 收起 理由
admin + 30 共享資料的黑幣獎(jiǎng)勵(lì)！

查看全部評(píng)分

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏 分享淘帖 頂頂 踩踩
回復(fù)

使用道具 舉報(bào)

本版積分規(guī)則

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

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

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