设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 电子技术分类讨论区 › 资料共享 › stm32循迹源码
返回列表 发新帖
查看: 1931|回复: 0
打印 上一主题 下一主题
收起左侧

stm32循迹源码

[复制链接]
跳转到指定楼层
楼主
ID:225962 发表于 2017-8-9 09:35 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
  1. #include <includes.h>
  2. //int x=4,z=0,v=0;
  3. //int flag=0;

  5. /******************************************
  6. *                                                                                                   
  7. *             延时程序 ms
  8. *
  9. ****************************************/

  11. void delay(unsigned int n)
  12. {
  13.         unsigned int y, k;
  14.         
  15.         while(n--)
  16.         {                                          
  17.                 for(y = 0; y < 160; y++)
  18.                 {
  19.                         for(k = 0; k < 76; k++)
  20.                         {
  21.                                 ;
  22.                         }
  23.                 }
  24.         }        
  25. }
  26. /**************************************************************************************************************************************
  27. *                                                                                                   
  28. *                                                           左拐弯 右拐弯
  29. *

  31. **************************************************************************************************************************************/

  33. void rightbig ()                 //右拐
  34. {
  35.         GPIO_ResetBits(GPIOB, GPIO_Pin_11);
  36.         TIM2->CCR3=50;       //PA^2        //左前  

  38.         GPIO_ResetBits(GPIOB, GPIO_Pin_10 );
  39.         TIM2->CCR2=10;                 //PA^0        //右前

  41.         GPIO_ResetBits(GPIOA, GPIO_Pin_5 );
  42.         TIM2->CCR4=50;                 //PA^3        //左后

  44.         GPIO_ResetBits(GPIOA, GPIO_Pin_4 );
  45.         TIM2->CCR1=10;                 //PA^1        //右后
  46. }


  49. void leftbig()                //左拐
  50. {
  51.         GPIO_ResetBits(GPIOB, GPIO_Pin_11);
  52.         TIM2->CCR3=10;       //PA^2        //左前

  54.         GPIO_ResetBits(GPIOB, GPIO_Pin_10 );
  55.         TIM2->CCR2=50;                 //PA^0        //右前

  57.         GPIO_ResetBits(GPIOA, GPIO_Pin_5 );
  58.         TIM2->CCR4=10;                 //PA^3        //左后

  60.         GPIO_ResetBits(GPIOA, GPIO_Pin_4 );
  61.         TIM2->CCR1=50;                 //PA^1        //右后

  63. }
  64. /**************************************************************************************************************************************
  65. *                                                                                                   
  66. *                                                                          停止
  67. *
  68. **************************************************************************************************************************************/
  69. //void stop()
  70. //{
  71. //        GPIO_ResetBits(GPIOA ,GPIO_Pin_0 );
  72. //        GPIO_ResetBits(GPIOA ,GPIO_Pin_1 );
  73. //        GPIO_ResetBits(GPIOB ,GPIO_Pin_2 );
  74. //        GPIO_ResetBits(GPIOB ,GPIO_Pin_3 );

  76. //}
  77. /**************************************************************************************************************************************
  78. *                                                                                                   
  79. *                                                           左右轮子分别反向
  80. *
  81. **************************************************************************************************************************************/
  82. void  leftgorightback()
  83. {
  84.         
  85.                 GPIO_ResetBits(GPIOB, GPIO_Pin_11);
  86.                 TIM2->CCR3=80;                                       
  87.         
  88.                 GPIO_ResetBits(GPIOA, GPIO_Pin_5 );
  89.                 TIM2->CCR4=80;                             //左前，左后向前走
  90.                
  91.                 GPIO_SetBits(GPIOB, GPIO_Pin_10 );
  92.                 TIM2->CCR2=80;        
  93.         
  94.             GPIO_SetBits(GPIOA, GPIO_Pin_4 );
  95.                 TIM2->CCR1=80;                                         //右前，右后向后走
  96. }

  98. void  leftbackrightgo()
  99. {
  100.                 GPIO_SetBits(GPIOB, GPIO_Pin_11);
  101.                 TIM2->CCR3=80;                                       
  102.         
  103.                 GPIO_SetBits(GPIOA, GPIO_Pin_5 );
  104.                 TIM2->CCR4=80;                             //左前，左后向后走
  105.                
  106.                 GPIO_ResetBits(GPIOB, GPIO_Pin_10 );
  107.                 TIM2->CCR2=80;        
  108.         
  109.             GPIO_ResetBits(GPIOA, GPIO_Pin_4 );
  110.                 TIM2->CCR1=80;                                         //右前，右后向左走
  111. }

  113. /**************************************************************************************************************************************
  114. *                                                                                                   
  115. *                                                           循迹函数
  116. *
  117. **************************************************************************************************************************************/
  118. void xunji()

  120. {
  121.         if(GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_12)==0&&GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_13)==1)//右边没有检测到相当于，右拐
  122.         {
  123.                 TIM2->CCR1 =10;        
  124.                 TIM2->CCR2 =10;        
  125.                 TIM2->CCR3 =99;        
  126.                 TIM2->CCR4 =99;                //右拐
  127.         }
  128.         
  129.         if(GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_12)==1&&GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_13)==0)//右边没检测到，左边黑线，左拐
  130.         {
  131.                 TIM2->CCR3 =10;        
  132.                 TIM2->CCR4 =10;        
  133.                 TIM2->CCR1 =99;        
  134.                 TIM2->CCR2 =99;                //左拐   
  135.         
  136.         }        
  137.         
  138.         if(GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_12)==0&&GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_13)==0)//都有，直走
  139.         {
  140.                 TIM2->CCR1 =50;        
  141.                 TIM2->CCR2 =50;        
  142.                 TIM2->CCR3 =50;        
  143.                 TIM2->CCR4 =50;                //直走
  144.                
  145.         }
  146.         
  147.         
  148. }
  149. /**************************************************************************************************************************************
  150. *                                                                                                   
  151. *                                                           走到交接处函数
  152. *
  153. **************************************************************************************************************************************/
  154. void begin()
  155. {
  156.         if(GPIO_ReadInputDataBit(GPIOA, GPIO_Pin_2)==1)
  157.         {
  158.                 TIM2->CCR1 =10;        
  159.                 TIM2->CCR2 =10;        
  160.                 TIM2->CCR3 =99;        
  161.                 TIM2->CCR4 =99;                //右拐
  162.                
  163.                 delay (10);
  164.         }        

  166. }

  168. void while_1()
  169. {
  170. //        rightbig ();
  171. //        leftbig ();
  172. //        leftgorightback();
  173.         leftbackrightgo();
  174. //        xunji ();        
  175. }

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

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

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

Powered by 单片机教程网

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