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

標題: 雙足競步機器人STM32源程序 [打印本頁]
作者: 20161615    時間: 2017-12-25 18:55
標題: 雙足競步機器人STM32源程序
雙足競步機器人

單片機源程序如下:
  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)


作者: 1934519398    時間: 2019-3-6 08:52
有電路就更好了



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