找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 1541|回复: 1
打印 上一主题 下一主题
收起左侧

STM32四路舵机双足机器程序

[复制链接]
跳转到指定楼层
楼主
ID:393178 发表于 2019-4-25 11:15 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
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"

  10. int main(void)
  11. {


  12.   delay_init();                  
  13.   LED_Init();
  14.   TIM2_PWM_Init(19999,71);                    
  15.   GpioInit();
  16.          stop();
  17.          go();
  18.          delay_ms(200);
  19.          go();
  20.          delay_ms(200);
  21.    go();
  22.          delay_ms(200);
  23. //while(1){
  24. //if(PBin(7)==1||PBin(8)==1)               // 1不亮灯   0亮灯  
  25. //         stop();         
  26. //if(PBin(8)==0&&PBin(7)==0)
  27. //go();
  28. //}
  29. }
  30. // int main(void)
  31. // {       
  32. //          u8 i=0,k=0;
  33. //  delay_init();                  
  34. //  LED_Init();
  35. //  TIM2_PWM_Init(19999,71);                    
  36. //  GpioInit();
  37. //         stop();
  38. //         go();
  39. //         delay_ms(200);
  40. //         go();
  41. //         delay_ms(200);
  42. //         go();
  43. //         delay_ms(200);
  44. //   while(1){
  45. //                 
  46. //                 go();
  47. //                delay_ms(200);
  48. //     k++;
  49. //         if(PAin(13)==0&&PAin(14)==0&&PAin(12)==0)
  50. //    youtiao();

  51. //                if(PAin(13)==1&&PAin(14)==1)
  52. //          zuotiao();
  53. //               
  54. //               
  55. //               
  56. //    if(PBin(6)==0||k>49)          //八字左转
  57. //                {
  58. //                if(PAin(13)==1&&PAin(14)==1)
  59. //          {
  60. //                zuotiao();
  61. //                        go();
  62. //                 zuotiao();
  63. //                }
  64. //               
  65. //                 go();
  66. //                 go();
  67. ////                 go();
  68. ////                 go();
  69. ////                 go();
  70. //               
  71. //                        zuotiao();
  72. //                        go();
  73. //                  go();
  74. //                   zuotiao();
  75. //                   go();
  76. ////      zuotiao();
  77. ////                  go();
  78. ////                         zuotiao();
  79. ////                  go();

  80. //                        delay_ms(100);
  81. //                        while(1)
  82. //                        {
  83. //      if(i==10)
  84. //                        {
  85. //                        i=0;
  86. //                        zuotiao1();       
  87. //                        }
  88. //                         zuozhuan();
  89. //                               
  90. //                  if(PBin(4)==1||PAin(14)==1||PAin(13)==1)       //八字左转之后的循迹
  91. //                        {
  92. //                        youtiao();
  93. //                        delay_ms(100);
  94. ////                        youtiao();
  95. ////      delay_ms(100);
  96. //                        while(1)
  97. //                        {
  98. //                               
  99. //                        go();
  100. //                   i++;
  101. //                  if(PAin(13)==0&&PAin(14)==0&&PAin(12)==0&&PBin(4)==0)
  102. //      {
  103. //                        zuotiao();
  104. //      
  105. //                        }
  106. //                  if((PAin(14)==1&&PBin(4)==1&&PAin(13)==1)||PBin(4)==0)
  107. //                        {       
  108. //            youtiao();
  109. //                       
  110. //                        }
  111. //                  if((PBin(7)==0&&i>50)||i>97)        //八字右转
  112. //                        {
  113. //       go();
  114. //                         go();
  115. //                         go();
  116. //                                go();
  117. //                         go();
  118. //                         go();
  119. //                        youtiao();
  120. //                        go();
  121. //                        go();       
  122. //                        youtiao();
  123. //                        go();
  124. //                        while(1)
  125. //                        {
  126. //                                      if(i==10)
  127. //                        {
  128. //                        i=0;
  129. //                        youtiao();       
  130. //                        }

  131. //                                 youzhuan();
  132. //                               
  133. //                        if((PAin(12)==1&&PAin(13)==1)||(PAin(14)==1&&PAin(4)==1))
  134. //                        {
  135. //                        zuotiao();                    //八字右转之后的循迹
  136. //                                go();
  137. //                        delay_ms(100);
  138. //                        zuotiao();
  139. //                                go();
  140. //                                delay_ms(100);
  141. //                        while(1)
  142. //      {
  143. //                               
  144. //                                go();
  145. //               
  146. //                  if(PAin(13)==0&&PAin(14)==0&&PAin(12)==0&&PBin(4)==0)
  147. //      youtiao();

  148. //                  if(PAin(13)==1&&PAin(14)==1||PAin(12)==0)
  149. //            zuotiao();

  150. //                        }                               
  151. //                        }
  152. //                        }
  153. //                        }
  154. //                        }                               
  155. //                        }
  156. //                  }
  157. //      }

  158. //                       
  159. //}
  160. //}
复制代码

所有资料51hei提供下载:
调试双足youtiaozuotiaogo.7z (188.84 KB, 下载次数: 12)


分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏 分享淘帖 顶 踩
回复

使用道具 举报

沙发
ID:1 发表于 2019-4-25 15:01 | 只看该作者
本帖需要重新编辑补全电路原理图,源码,详细说明与图片即可获得100+黑币(帖子下方有编辑按钮)
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表