久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 3976|回復: 1
收起左側

雙足競步機器人STM32源程序

[復制鏈接]
ID:266654 發表于 2017-12-25 18:55 | 顯示全部樓層 |閱讀模式
雙足競步機器人

單片機源程序如下:
  1. #include "led.h"
  2. #include "delay.h"
  3. #include "sys.h"
  4. #include "pwm.h"
  5. #include "text.h"
  6. #include "etix.h"
  7. #include "cs.h"
  8. #include "usart.h"
  9. #include "csb.h"

  11. int main(void)
  12. {       
  13.           u8 i=0,k=0;
  14.   delay_init();                  
  15.   LED_Init();
  16.   TIM2_PWM_Init(19999,71);                    
  17.   GpioInit();
  18.          stop();
  19.          go();
  20.          delay_ms(200);
  21.          go();
  22.          delay_ms(200);
  23.          go();
  24.          delay_ms(200);
  25.    while(1){
  26.                  
  27.                  go();
  28.                 delay_ms(200);
  29.      k++;
  30.          if(PAin(13)==0&&PAin(14)==0&&PAin(12)==0)
  31.     youtiao();

  33.                 if(PAin(13)==1&&PAin(14)==1)
  34.           zuotiao();
  35.                
  36.                
  37.                
  38.     if(PBin(6)==0||k>49)          //八字左轉
  39.                 {
  40.                 if(PAin(13)==1&&PAin(14)==1)
  41.           {
  42.                 zuotiao();
  43.                         go();
  44.                  zuotiao();
  45.                 }
  46.                
  47.                  go();
  48.                  go();
  49. //                 go();
  50. //                 go();
  51. //                 go();
  52.                
  53.                         zuotiao();
  54.                         go();
  55.                   go();
  56.                    zuotiao();
  57.                    go();
  58. //      zuotiao();
  59. //                  go();
  60. //                         zuotiao();
  61. //                  go();

  63.                         delay_ms(100);
  64.                         while(1)
  65.                         {
  66.       if(i==10)
  67.                         {
  68.                         i=0;
  69.                         zuotiao1();       
  70.                         }
  71.                          zuozhuan();
  72.                                
  73.                   if(PBin(4)==1||PAin(14)==1||PAin(13)==1)       //八字左轉之后的循跡
  74.                         {
  75.                         youtiao();
  76.                         delay_ms(100);
  77. //                        youtiao();
  78. //      delay_ms(100);
  79.                         while(1)
  80.                         {
  81.                                
  82.                         go();
  83.                    i++;
  84.                   if(PAin(13)==0&&PAin(14)==0&&PAin(12)==0&&PBin(4)==0)
  85.       {
  86.                         zuotiao();
  87.       
  88.                         }
  89.                   if((PAin(14)==1&&PBin(4)==1&&PAin(13)==1)||PBin(4)==0)
  90.                         {       
  91.             youtiao();
  92.                        
  93.                         }
  94.                   if((PBin(7)==0&&i>50)||i>97)        //八字右轉
  95.                         {
  96.        go();
  97.                          go();
  98.                          go();
  99.                                 go();
  100.                          go();
  101.                          go();
  102.                         youtiao();
  103.                         go();
  104.                         go();       
  105.                         youtiao();
  106.                         go();
  107.                         while(1)
  108.                         {
  109.                                       if(i==10)
  110.                         {
  111.                         i=0;
  112.                         youtiao();       
  113.                         }

  115.                                  youzhuan();
  116.                                
  117.                         if((PAin(12)==1&&PAin(13)==1)||(PAin(14)==1&&PAin(4)==1))
  118.                         {
  119.                         zuotiao();                    //八字右轉之后的循跡
  120.                                 go();
  121.                         delay_ms(100);
  122.                         zuotiao();
  123.                                 go();
  124.                                 delay_ms(100);
  125.                         while(1)
  126.       {
  127.                                
  128.                                 go();
  129.                
  130.                   if(PAin(13)==0&&PAin(14)==0&&PAin(12)==0&&PBin(4)==0)
  131.       youtiao();

  133.                   if(PAin(13)==1&&PAin(14)==1||PAin(12)==0)
  134.             zuotiao();

  136.                         }                               
  137.                         }
  138.                         }
  139.                         }
  140.                         }                               
  141.                         }
  142.                   }
  143.       }

  145.                        
  146. }
  147. }

復制代碼

所有資料51hei提供下載:
雙足.rar (286.11 KB, 下載次數: 72)
回復

使用道具 舉報

ID:433921 發表于 2019-3-6 08:52 來自手機 | 顯示全部樓層
有電路就更好了
回復

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 羞羞午夜 | 国产精品国色综合久久 | 又黄又色 | 一级一片在线观看 | 91视频一区二区三区 | 国内精品视频免费观看 | 欧美一区二区三区电影 | av天天干| 日韩欧美在线一区 | 黄色av网站免费看 | 毛片在线免费 | 精品欧美一区二区三区久久久 | 日韩欧美国产综合 | 欧美一级二级在线观看 | 综合网视频 | 男人天堂网址 | 国产资源在线视频 | 中文字幕在线看 | 日韩午夜影院 | 国产精品精品 | 偷拍自拍在线观看 | 久久国产欧美日韩精品 | 国产精品1区2区 | 最近中文字幕免费 | 精品国产99| 精品国模一区二区三区欧美 | 久久中文免费视频 | 成人亚洲综合 | 久久一区| 日韩精品久久久 | 综合色久| 久久国产精品一区二区三区 | 欧美自拍另类 | 一区二区三区久久久 | 干干天天 | 国产精品一级在线观看 | 产真a观专区 | 亚洲一区二区三区在线免费观看 | 国产精品一区二区福利视频 | 懂色中文一区二区在线播放 | 日韩a在线观看 |