欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

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

QQ登錄

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

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

六足機(jī)器人源碼分享 sixfeet-robot初始

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:332915 發(fā)表于 2018-5-18 13:20 | 只看該作者 回帖獎(jiǎng)勵(lì) |倒序?yàn)g覽 |閱讀模式
stm32f103rc主控,具體看程序吧。這是初始程序,想要完整的私聊。

單片機(jī)源程序如下:
  1. #include "delay.h"
  2. #include "uart.h"
  3. #include "LobotServoController.h"
  4. #include "bool.h"
  5. #include "work.h"
  6. #include "lcd1602.h"
  7. #include "timer.h"
  8. #include "wave.h"
  9. #include "FreeRTOS.h"
  10. #include "task.h"
  11. #include "queue.h"

  12. //外設(shè)引腳
  13. /*
  14. 1602: -、+、-、pb15/pb14/pb13、pc0-pc7、+/-
  15. 超聲波:trig pb5/echo pb6
  16. */

  17. extern u16 Distance;

  18. void vTask0_length( void *pvParameters)    //測(cè)距任務(wù)
  19. {
  20.         u8 i=0;
  21.         while(1)
  22.         {
  23.                 if(i==0)
  24.                 {
  25.                         GPIO_SetBits(GPIOB,GPIO_Pin_10); i=1;
  26.                 }
  27.                 else
  28.                 {
  29.                         GPIO_ResetBits(GPIOB,GPIO_Pin_10); i=0;
  30.                 }
  31.                 Wave_SRD_Strat();
  32.                 if(Distance>=200) Distance=200;
  33.                 //LCD1602_Show_Str(0,0,"Distance");
  34.                 //LCD1602_Show_num(0,9,Distance);
  35.     vTaskDelay(300 / portTICK_RATE_MS);
  36.         }
  37. }

  38. void vTask0_work( void *pvParameters)   //機(jī)器人動(dòng)作任務(wù)
  39. {
  40.         u8 head=2;
  41.          stop();
  42.          hold();
  43.          while(1)
  44.          {
  45.                  if(Distance<=40)  //先左邊再右邊測(cè)距,若都小于閾值,后退
  46.                  {
  47.                          if(head==2)     
  48.                          {
  49.                                  head_left(); head=1;         
  50.                          }
  51.                          else if(head==1)
  52.                          {
  53.                                  head_right(); head=3;
  54.                          }
  55.                          else  
  56.                          {
  57.                                  turn_back(); head_centre(); head=2;
  58.                          }
  59.                  }
  60.                  else
  61.                  {
  62.                          if(head==1)
  63.                          {
  64.                                  turn_left(); head_centre(); head=2;
  65.                          }
  66.                          else if(head==2) ahead();
  67.                          else
  68.                          {
  69.                                  turn_right(); head_centre(); head=2;
  70.                          }
  71.                  }
  72.                  vTaskDelay(300 / portTICK_RATE_MS);
  73.          }        
  74. }

  75. int main(void)
  76. {
  77.          SystemInit();//系統(tǒng)時(shí)鐘等初始化
  78.         delay_init();             //延時(shí)初始化
  79.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//設(shè)置NVIC中斷分組2:2位搶占優(yōu)先級(jí),2位響應(yīng)優(yōu)先級(jí)
  80.         uartInit(9600);//串口初始化為9600
  81.         GPIO_Configuration();
  82.         LCD1602_Init();
  83.         Timer_SRD_Init(5000,7199);
  84.         Wave_SRD_Init();

  85.                   xTaskCreate(vTask0_length,"length",200,NULL,1,NULL);
  86.            xTaskCreate(vTask0_work,"work",200,NULL,2,NULL);
  87.          
  88.            vTaskStartScheduler();          //開(kāi)啟任務(wù)調(diào)度
  89. }

復(fù)制代碼

初始化部分分享給大家,請(qǐng)多多指教:
sixfeet-robot初始.rar (599.4 KB, 下載次數(shù): 29)


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

使用道具 舉報(bào)

沙發(fā)
ID:488747 發(fā)表于 2019-5-23 15:25 | 只看該作者
樓主使用的什么驅(qū)動(dòng)板?
回復(fù)

使用道具 舉報(bào)

板凳
ID:868894 發(fā)表于 2020-12-27 17:32 來(lái)自觸屏版 | 只看該作者
你好 有完整代碼嗎 我現(xiàn)在在做一個(gè)類似的項(xiàng)目
回復(fù)

使用道具 舉報(bào)

本版積分規(guī)則

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

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

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