当前位置:   article > 正文

基于STM32的蓝牙遥控避障小车_stm32蓝牙模块控制小车

stm32蓝牙模块控制小车

文章目录

  • 前言
  • 一、组成部分及功能介绍
  • 二、代码实例
    • 1.main函数
    • 2.定时器初始化
    • 3.串口部分
    • 4.超声波部分
    • 5.舵机
  • 三、实物效果
  • 总结


前言

    这是笔者第一次尝试在CSDN这个平台上编写文章,主要是想借此来记录一下自己做过的一些小项目,算是为生活添加乐趣叭~(^&^)

 本文介绍的是基于STM32的蓝牙遥控避障小车,其主要实现两个功能,分别为遥控模式以及自主避障模式。                         


提示:以下是本篇文章正文内容,下面案例可供参考

一、组成部件及功能介绍

1.采用STM32F103系列为主控芯片

2.采用C-SR04超声波模块避障。

  1. SR04超声波测距模块可提供约2cm到400厘米的非接触式距离感测功能,测距精度可达高到3毫米;模块包括超声波发射器,接收器与控制电路像智能小车的测距以及转向,或是一些项目中,常常会用到。智能小车测距可以及时发现前方的障碍物,使智能小车可以及时转向,避开障碍物。给超声波模块接入电源和地给脉冲触发引脚(trig)输入一个长为20us的高电平方波输入方波后,模块会自动发射8个40KHz的声波,与此同时回波引脚(echo)端的电平会由0变为1;当超声波返回被模块接收到时,回波引脚端的电平会由1变为0;(此时应该停止定时器计数),定时器记下的这个时间即为超声波由发射到返回的总时长根据声音中的速度为344米/秒,即可计算出所测的距离。

 在一些初始化函数调用后,对Echo的引脚进行测量。倘若改引脚变为高,则是开始推测。当它变成0的时候,则是探测结束。之后对于时间进行计算便可以得到距离。

3.采用HC-05蓝牙模块进行远程遥控控制小车的行进方向。

此模块实现了无线电远距离控制小车的停启、方向行驶的功能,在整个小车系统中起到不可忽视的作用。

无线遥控工作原理

此蓝牙的型号是HC-05

工作简化图如下:

HC-05蓝牙串口通讯模块具有两种工作模式:命令响应工作模式(AT)和自动连接工作模式。在自动连接工作模式下模块又可分为主(Master)、从(Slave)和回环(Loopback)三种工作角色。当模块处于自动连接工作模式时,将自动根据事先设定的方式连接的数据传输;当模块处于命令响应工作模式时能执行AT命令,用户可向模块发送各种AT 指令,为模块设定控制参数或发布控制命令。

模块上电,未配对情况下就是AT模式,波特率为模块本身的波特率,默认:9600,发送一次AT指令时需要置高一次PIO11;

PIO11 置高电平后,再给模块上电,此时模块进入AT 模式,波特率固定为:38400,可以直接发送AT指令。

在蓝牙模块中有一个小按键,按一下就置高一次PIO11。也就是说,第一种方法需要每发送一次AT指令按一次;而第二种方式是长按的过程中上电,之后就无需再管了,直接发送AT命令即可。

在蓝牙模块上有灯,当灯快闪的时候,就是自动连接工作模式;当灯慢闪的时候,就是命令响应工作模式。

配置好相应的PWM后,直接通过手机蓝牙与他相接,通过相应的软件进行调节发送指令,单片机通过串口会得到指令,产生相应的动作。

HC-05的状态现象很明显,操作也很方便。

4.采用SG90舵机辅助超声波模块进行转向避障

 

选择使用SG90舵机,其性能强且不易于损坏。而且舵机本身十分轻巧方便组装,能够实现0~180度范围的转向。

舵机是一种根据输入PWM信号占空比来控制输出角度的装置输入PWM信号要求:周期为20ms,高电平宽度为0.5ms~2.5ms。通过输入不同占空比的PWM来控制舵机的不同转向角度,从而带动超声波模块旋转以实现避障功能。

二、代码实列

1.main函数

    主函数里面其实主要就做了一个事情,那就是在while(1)中不断判断串口传来的数据是多少,小车再通过传过来的数据来具体做出对应的判断

  1. #include "stm32f10x.h" // Device header
  2. #include "oled.h"
  3. #include "timer.h"
  4. #include "DELAY.h"
  5. #include "YunTai.h"
  6. #include "Dianji.h"
  7. #include "CaoSenBo.h"
  8. #include "USART.h"
  9. int g_USART1_FLAG = 0; //蓝牙标志位
  10. int Mode = 0; //模式标志位
  11. extern int dis;
  12. int main(void)
  13. {
  14. NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
  15. Dianji_Init();
  16. OLED_Init();
  17. OLED_Clear();
  18. //SR04_GPIO_Init(); // Trign PC10
  19. ultrasonic_Init();
  20. Init_TIM5_PWM(19999 ,71);//云台
  21. Init_TIM8_PWM(899,7);//电机
  22. uart_init(115200); //蓝牙
  23. TIME3_Init();//超声波
  24. //TIM2_Cap_Init(0XFFFF,72-1);//以1MHZ的频率计数
  25. SERVO_SetAng(90);
  26. while(1)
  27. {
  28. if(Mode == 1) //避障模式
  29. {
  30. HC_SR04_Avoid();
  31. OLED_ShowNum(1,1,dis,3);
  32. }
  33. if(Mode == 2)//遥控模式
  34. {
  35. SERVO_SetAng(90);
  36. if(g_USART1_FLAG == 1)
  37. {
  38. run(); //前进
  39. g_USART1_FLAG = 0;
  40. }
  41. if(g_USART1_FLAG == 2)
  42. {
  43. Retreat(); //后退
  44. g_USART1_FLAG = 0;
  45. }
  46. if(g_USART1_FLAG == 3)
  47. {
  48. go_left(); //左转
  49. g_USART1_FLAG = 0;
  50. }
  51. if(g_USART1_FLAG == 4)
  52. {
  53. go_right(); //右转
  54. g_USART1_FLAG = 0;
  55. }
  56. if(g_USART1_FLAG ==5)
  57. {
  58. Stop(); //停车
  59. g_USART1_FLAG = 0;
  60. }
  61. }
  62. }
  63. }

2.定时器初始化

  1. #include "stm32f10x.h" // Device header
  2. #include "sys.h"
  3. void Init_TIM5_PWM(u16 arr ,u16 psc) //云台即舵机
  4. {
  5. RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE);
  6. GPIO_InitTypeDef GPIO_InitStructure;
  7. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;
  8. GPIO_InitStructure.GPIO_Pin = GPIO_Pin_3;
  9. GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  10. GPIO_Init(GPIOA, &GPIO_InitStructure);
  11. RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM5, ENABLE);
  12. TIM_InternalClockConfig(TIM5);
  13. TIM_TimeBaseInitTypeDef TIM_TimrBaseInitStructure;
  14. TIM_TimrBaseInitStructure.TIM_ClockDivision = TIM_CKD_DIV1;
  15. TIM_TimrBaseInitStructure.TIM_CounterMode = TIM_CounterMode_Up ;
  16. TIM_TimrBaseInitStructure.TIM_Period = arr ;
  17. TIM_TimrBaseInitStructure.TIM_Prescaler = psc;
  18. TIM_TimrBaseInitStructure.TIM_RepetitionCounter = 0 ;
  19. TIM_TimeBaseInit(TIM5, &TIM_TimrBaseInitStructure);
  20. TIM_ClearFlag(TIM5, TIM_FLAG_Update);
  21. TIM_OCInitTypeDef TIM_OCInitStructure;
  22. TIM_OCStructInit(&TIM_OCInitStructure); //为了避免因部分结构体成员未赋初使值而导致可能的错误,这里先将结构体赋初值,再改变部分结构体成员的值就行了
  23. TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; //设置输出比较的模式
  24. TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; //设置输出比较的极性,这里是极性不翻转
  25. TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; //设置输出使能
  26. TIM_OCInitStructure.TIM_Pulse = 0; //用于设置CCR
  27. TIM_OC4Init(TIM5, &TIM_OCInitStructure);
  28. //TIM_OC2Init(TIM2, &TIM_OCInitStructure);
  29. TIM_Cmd(TIM5, ENABLE);
  30. }
  31. void Init_TIM8_PWM(u16 arr, u16 psc) //电机
  32. {
  33. GPIO_InitTypeDef GPIO_InitStructure;
  34. TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
  35. TIM_OCInitTypeDef TIM_OCInitStructure;
  36. RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM8, ENABLE);
  37. RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC, ENABLE);
  38. GPIO_InitStructure.GPIO_Pin = GPIO_Pin_9 | GPIO_Pin_8 | GPIO_Pin_7 | GPIO_Pin_6;
  39. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;
  40. GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  41. GPIO_Init(GPIOC, &GPIO_InitStructure);
  42. TIM_TimeBaseStructure.TIM_Period = arr;
  43. TIM_TimeBaseStructure.TIM_Prescaler = psc;
  44. TIM_TimeBaseStructure.TIM_ClockDivision = 0;
  45. TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
  46. TIM_TimeBaseInit(TIM8, &TIM_TimeBaseStructure);
  47. TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;
  48. TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;
  49. TIM_OCInitStructure.TIM_Pulse = 0;
  50. TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;
  51. TIM_OCInitStructure.TIM_OutputNState = TIM_OutputNState_Enable;
  52. TIM_OCInitStructure.TIM_OCNPolarity = TIM_OCNPolarity_High;
  53. TIM_OCInitStructure.TIM_OCIdleState = TIM_OCIdleState_Set;
  54. TIM_OCInitStructure.TIM_OCNIdleState = TIM_OCIdleState_Reset;
  55. TIM_OC1Init(TIM8, &TIM_OCInitStructure);
  56. TIM_OC1PreloadConfig(TIM8, TIM_OCPreload_Enable); // CH1 ----A PC6
  57. TIM_OC2Init(TIM8, &TIM_OCInitStructure);
  58. TIM_OC2PreloadConfig(TIM8, TIM_OCPreload_Enable); // CH2 ----B PC7
  59. TIM_OC3Init(TIM8, &TIM_OCInitStructure);
  60. TIM_OC3PreloadConfig(TIM8, TIM_OCPreload_Enable); // CH3 ----C PC8
  61. TIM_OC4Init(TIM8, &TIM_OCInitStructure);
  62. TIM_OC4PreloadConfig(TIM8, TIM_OCPreload_Enable); // CH4 ----D PC9
  63. TIM_CtrlPWMOutputs(TIM8, ENABLE);
  64. TIM_ARRPreloadConfig(TIM8, ENABLE);
  65. TIM_Cmd(TIM8, ENABLE);
  66. TIM_SetCompare1(TIM8, 0); // BL
  67. TIM_SetCompare2(TIM8, 0); // FL
  68. TIM_SetCompare3(TIM8, 0); // FR
  69. TIM_SetCompare4(TIM8, 0); // BR
  70. }
  71. void TIME3_Init(void) //超声波
  72. {
  73. NVIC_InitTypeDef NVIC_InitStructure;
  74. TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure;
  75. RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3,ENABLE);
  76. NVIC_InitStructure.NVIC_IRQChannel=TIM3_IRQn;
  77. NVIC_InitStructure.NVIC_IRQChannelCmd=ENABLE;
  78. NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=1;
  79. NVIC_InitStructure.NVIC_IRQChannelSubPriority=0;
  80. NVIC_Init(&NVIC_InitStructure);
  81. TIM_TimeBaseInitStructure.TIM_Period=99; //ARR
  82. TIM_TimeBaseInitStructure.TIM_Prescaler=17; //PSC
  83. TIM_TimeBaseInitStructure.TIM_CounterMode=TIM_CounterMode_Up;
  84. TIM_TimeBaseInitStructure.TIM_ClockDivision=1;
  85. TIM_TimeBaseInitStructure.TIM_RepetitionCounter=1;
  86. TIM_TimeBaseInit(TIM3,&TIM_TimeBaseInitStructure);
  87. TIM_ITConfig(TIM3,TIM_IT_Update,ENABLE);
  88. }
  89. //下面注释的部分是我尝试用定时器输入捕获的方式来运行超声波
  90. //结果发现效果并不理想就放弃了
  91. //TIM_ICInitTypeDef TIM2_ICInitStructure;
  92. //void TIM2_Cap_Init(u16 arr,u16 psc) //超声波
  93. //{
  94. // GPIO_InitTypeDef GPIO_InitStructure;
  95. // TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
  96. // NVIC_InitTypeDef NVIC_InitStructure;
  97. // RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);
  98. // RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE);
  99. //
  100. // GPIO_InitStructure.GPIO_Pin = GPIO_Pin_2;
  101. // GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPD;
  102. // GPIO_Init(GPIOA, &GPIO_InitStructure);
  103. // GPIO_ResetBits(GPIOA,GPIO_Pin_2);
  104. //
  105. //
  106. // TIM_TimeBaseStructure.TIM_Period = arr;
  107. // TIM_TimeBaseStructure.TIM_Prescaler =psc;
  108. // TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1;
  109. // TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
  110. // TIM_TimeBaseInit(TIM2, &TIM_TimeBaseStructure);
  111. //
  112. // TIM2_ICInitStructure.TIM_Channel = TIM_Channel_3;
  113. // TIM2_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_Rising;
  114. // TIM2_ICInitStructure.TIM_ICSelection = TIM_ICSelection_DirectTI;
  115. // TIM2_ICInitStructure.TIM_ICPrescaler = TIM_ICPSC_DIV1;
  116. // TIM2_ICInitStructure.TIM_ICFilter = 0x00;
  117. // TIM_ICInit(TIM2, &TIM2_ICInitStructure);
  118. //
  119. //
  120. // NVIC_InitStructure.NVIC_IRQChannel = TIM2_IRQn ;
  121. // NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 2;
  122. // NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0;
  123. // NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
  124. // NVIC_Init(&NVIC_InitStructure);
  125. //
  126. // TIM_ITConfig(TIM2,TIM_IT_Update|TIM_IT_CC3,ENABLE);
  127. //
  128. // TIM_Cmd(TIM2,ENABLE );
  129. //}
  130. //u8 TIM5CH1_CAPTURE_STA=0;
  131. //u16 TIM5CH1_CAPTURE_VAL;
  132. //
  133. //
  134. //void TIM2_IRQHandler(void)
  135. //{
  136. // if((TIM5CH1_CAPTURE_STA&0X80)==0)
  137. // {
  138. // if (TIM_GetITStatus(TIM2, TIM_IT_Update) != RESET)
  139. //
  140. // {
  141. // if(TIM5CH1_CAPTURE_STA&0X40)
  142. // {
  143. // if((TIM5CH1_CAPTURE_STA&0X3F)==0X3F)
  144. // {
  145. // TIM5CH1_CAPTURE_STA|=0X80;
  146. // TIM5CH1_CAPTURE_VAL=0XFFFF;
  147. // }else TIM5CH1_CAPTURE_STA++;
  148. // }
  149. // }
  150. // if (TIM_GetITStatus(TIM2, TIM_IT_CC3) != RESET)
  151. // {
  152. // if(TIM5CH1_CAPTURE_STA&0X40)
  153. // {
  154. // TIM5CH1_CAPTURE_STA|=0X80;
  155. // TIM5CH1_CAPTURE_VAL=TIM_GetCapture3(TIM2);
  156. // TIM_OC3PolarityConfig(TIM2,TIM_ICPolarity_Rising);
  157. // }else
  158. // {
  159. // TIM5CH1_CAPTURE_STA=0;
  160. // TIM5CH1_CAPTURE_VAL=0;
  161. // TIM_SetCounter(TIM2,0);
  162. // TIM5CH1_CAPTURE_STA|=0X40;
  163. // TIM_OC3PolarityConfig(TIM2,TIM_ICPolarity_Falling);
  164. // }
  165. // }
  166. // }
  167. //
  168. // TIM_ClearITPendingBit(TIM2, TIM_IT_CC3|TIM_IT_Update);
  169. //
  170. //}

3.串口部分

串口部分只需要再其数据接收部分添加对接收信号的判断并赋值就行了,其他的程序可以参考引用正点原子关于串口部分的模板

  1. void USART1_IRQHandler(void) //串口1中断服务程序
  2. {
  3. u8 Res;
  4. #if SYSTEM_SUPPORT_OS //如果SYSTEM_SUPPORT_OS为真,则需要支持OS
  5. OSIntEnter();
  6. #endif
  7. if(USART_GetITStatus(USART1, USART_IT_RXNE) != RESET) //接收中断(数据必须是0xod 0xoa结尾)
  8. {
  9. Res =USART_ReceiveData(USART1); //读取接收到的数据
  10. if(Res == 'A') g_USART1_FLAG = 1;//前进
  11. if(Res == 'B') g_USART1_FLAG = 2;//后退
  12. if(Res == 'C') g_USART1_FLAG = 3;//左
  13. if(Res == 'D') g_USART1_FLAG = 4;//右
  14. if(Res == 'E') g_USART1_FLAG = 5;//停
  15. if(Res == 'F') Mode = 1;//打开避障模式
  16. if(Res == 'G') Mode = 2;//打开遥控模式
  17. if((USART_RX_STA&0x8000)==0)//接收未完成
  18. {
  19. if(USART_RX_STA&0x4000)//接收到了0x0d
  20. {
  21. if(Res!=0x0a)USART_RX_STA=0;//接收错误重新开始
  22. else USART_RX_STA|=0x8000; //接收完成了
  23. }
  24. else //还没接收到0X0D
  25. {
  26. if(Res==0x0d)USART_RX_STA|=0x4000;
  27. else
  28. {
  29. USART_RX_BUF[USART_RX_STA&0X3FFF]=Res ;
  30. USART_RX_STA++;
  31. if(USART_RX_STA>(USART_REC_LEN-1))USART_RX_STA=0;//如果SYSTEM_SUPPORT_OS为真,则需要支持OS
  32. }
  33. }
  34. }
  35. }

4.超声波部分

  1. #include "stm32f10x.h" // Device header
  2. #include "CaoSenBo.h"
  3. #include "timer.h"
  4. #include "oled.h"
  5. #include "Dianji.h"
  6. #include "YunTai.h"
  7. #include "DELAY.h"
  8. int time = 0;
  9. unsigned int delay_u;;
  10. int Count = 0;
  11. int Distance0 = 0;
  12. int Distance1 = 0;
  13. int dis = 0;
  14. //extern u8 TIM5CH1_CAPTURE_STA; //??????
  15. //extern u16 TIM5CH1_CAPTURE_VAL; //?????
  16. //void SR04_GPIO_Init(void)
  17. //{
  18. // GPIO_InitTypeDef GPIO_InitStructure;
  19. //
  20. // RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC,ENABLE);
  21. // GPIO_InitStructure.GPIO_Pin=GPIO_Pin_12; //trio
  22. // GPIO_InitStructure.GPIO_Mode=GPIO_Mode_Out_PP;
  23. // GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz;
  24. // GPIO_Init(GPIOC,&GPIO_InitStructure);
  25. //
  26. // GPIO_SetBits(GPIOC,GPIO_Pin_0);
  27. //}
  28. //int SR04_Distance(void)
  29. //{
  30. // Trign = 0;
  31. // Delay(13);
  32. // Trign = 1;
  33. //
  34. // if(TIM5CH1_CAPTURE_STA&0X80)
  35. // {
  36. // time=TIM5CH1_CAPTURE_STA&0X3F;
  37. // time*=65536;
  38. // time+=TIM5CH1_CAPTURE_VAL;
  39. // Distance = time*0.034/2;
  40. // //printf("HIGH:%d us\r\n",time);
  41. // TIM5CH1_CAPTURE_STA=0;
  42. // }
  43. // return Distance;
  44. //}
  45. //上面注释掉的这段是原本用输入捕获方式来运行的程序
  46. void ultrasonic_Init(void)
  47. {
  48. GPIO_InitTypeDef GPIO_InitStructure;
  49. RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC,ENABLE);
  50. GPIO_InitStructure.GPIO_Pin=GPIO_Pin_12; //trio
  51. GPIO_InitStructure.GPIO_Mode=GPIO_Mode_Out_PP;
  52. GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz;
  53. GPIO_Init(GPIOC,&GPIO_InitStructure);
  54. GPIO_InitStructure.GPIO_Pin=GPIO_Pin_10; //echo
  55. GPIO_InitStructure.GPIO_Mode=GPIO_Mode_IN_FLOATING;
  56. GPIO_Init(GPIOC,&GPIO_InitStructure);
  57. GPIO_ResetBits(GPIOB,GPIO_Pin_12);
  58. }
  59. int GetDistance(void)
  60. {
  61. int i;
  62. for(i=5;i>0;i--) //循环6次采集距离
  63. {
  64. GPIO_ResetBits(GPIOC,GPIO_Pin_12);
  65. GPIO_SetBits(GPIOC,GPIO_Pin_12); //拉高trig
  66. Delay(13); //保持10us
  67. GPIO_ResetBits(GPIOC,GPIO_Pin_12); //拉低trig
  68. while(GPIO_ReadInputDataBit(GPIOC,GPIO_Pin_10)==0); //等待echo管脚输出高电平后打开TIM3计时
  69. TIM_Cmd(TIM3,ENABLE); //打开TIM3,捕获时间
  70. while(GPIO_ReadInputDataBit(GPIOC,GPIO_Pin_10)==1); //等待声音信号结束
  71. TIM_Cmd(TIM3,DISABLE); //关闭TIM3
  72. Count=TIM_GetCounter(TIM3); //获取TIM3的该次计数值,即读取TIM3寄存器CNT
  73. Distance0=calculer(Count); //调用函数计算距离
  74. Distance1=Distance1+Distance0; //距离的累加,用于后续计算平均距离
  75. }
  76. Distance1=Distance1/6; //平均距离
  77. return Distance1;
  78. }
  79. u32 calculer(u32 count)
  80. {
  81. u32 Distance;
  82. Distance=((float)(count+100*time)*0.425)/100; //距离计算公式
  83. time=0; //清空TIM3的中断次数
  84. return Distance;
  85. }
  86. void TIM3_IRQHandler(void)
  87. {
  88. if(TIM_GetFlagStatus(TIM3,TIM_FLAG_Update)!=RESET)
  89. {
  90. time++; //中断标志自加1
  91. TIM_ClearFlag(TIM3,TIM_FLAG_Update); //清楚中断标志位
  92. }
  93. }
  94. void HC_SR04_Avoid(void) //根据距离来进行转向判断
  95. {
  96. dis = GetDistance();
  97. if(dis>60)
  98. {
  99. run();
  100. }
  101. else if(dis<40)
  102. {
  103. Stop();
  104. Delay_ms(1000);
  105. SERVO_SetAng(180); //此为舵机角度函数
  106. Delay_ms(1000);
  107. dis = GetDistance();
  108. if(dis>=60)
  109. {
  110. go_left();
  111. Delay_ms(625);
  112. SERVO_SetAng(90);
  113. Delay_ms(20);
  114. run();
  115. }
  116. else if(dis<60)
  117. {
  118. SERVO_SetAng(0);
  119. Delay_ms(20);
  120. go_right();
  121. Delay_ms(625);
  122. SERVO_SetAng(90);
  123. Delay_ms(20);
  124. run();
  125. }
  126. }
  127. }

5.舵机

  1. #include "stm32f10x.h" // Device header
  2. void SERVO_SetAng(float Angle)
  3. {
  4. TIM_SetCompare4(TIM5, Angle/180*2000+500);
  5. }

6.电机转向

  1. #include "stm32f10x.h" // Device header
  2. #include "timer.h"
  3. void Dianji_Init(void)//电机初始化
  4. {
  5. GPIO_InitTypeDef GPIO_InitStructure;
  6. RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE); //使能GPIOB时钟
  7. GPIO_InitStructure.GPIO_Pin = GPIO_Pin_2; //端口配置
  8. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; //推挽输出
  9. GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; // 50Mhz速度
  10. GPIO_Init(GPIOB, &GPIO_InitStructure);
  11. RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB | RCC_APB2Periph_GPIOA | RCC_APB2Periph_AFIO, ENABLE); GPIO_InitStructure.GPIO_Pin = GPIO_Pin_3; //端口配置
  12. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; //推挽输出
  13. GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; // 50Mhz速度
  14. GPIO_Init(GPIOB, &GPIO_InitStructure);
  15. GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable, ENABLE);
  16. }
  17. void run(void)
  18. {
  19. GPIO_ResetBits(GPIOB, GPIO_Pin_2); //右轮
  20. GPIO_SetBits(GPIOB, GPIO_Pin_3); //左轮
  21. TIM_SetCompare1(TIM8, 600); // 右
  22. TIM_SetCompare2(TIM8, 610); // 左
  23. }
  24. void go_left(void)
  25. {
  26. GPIO_ResetBits(GPIOB, GPIO_Pin_2); //右轮
  27. GPIO_ResetBits(GPIOB, GPIO_Pin_3); //左轮
  28. TIM_SetCompare1(TIM8, 500); // 右
  29. TIM_SetCompare2(TIM8, 500); // 左
  30. }
  31. void go_right(void)
  32. {
  33. GPIO_SetBits(GPIOB, GPIO_Pin_2); //右轮
  34. GPIO_SetBits(GPIOB, GPIO_Pin_3); //左轮
  35. TIM_SetCompare1(TIM8, 500); // 右
  36. TIM_SetCompare2(TIM8, 500); // 左
  37. }
  38. void Stop(void)
  39. {
  40. GPIO_ResetBits(GPIOB, GPIO_Pin_2); //右轮
  41. GPIO_SetBits(GPIOB, GPIO_Pin_3); //左轮
  42. TIM_SetCompare1(TIM8, 0); // 右
  43. TIM_SetCompare2(TIM8, 0); // 左
  44. }
  45. void Retreat(void) //后退
  46. {
  47. GPIO_SetBits(GPIOB, GPIO_Pin_2); //右轮
  48. GPIO_ResetBits(GPIOB, GPIO_Pin_3); //左轮
  49. TIM_SetCompare1(TIM8, 545); // 右
  50. TIM_SetCompare2(TIM8, 550); // 左
  51. }

以上便是代码部分的内容了(^^)

三、实物展示


 

 

注:这里用来连接蓝牙的手机软件随便在网上就可以找到的。

总结

     以上便是这篇文章的全部内容啦!呼~想不到还是有些累的(**)

笔者在这里也是想对看到这篇文章的朋友说几句话,或许你现在正因为各种程序呀电路呀等等等等。。问题所困扰,请一定不要着急,慢慢来仔细想,冷静面对问题才能将其迎刃而解哦!!

收工!

声明:本文内容由网友自发贡献,不代表【wpsshop博客】立场,版权归原作者所有,本站不承担相应法律责任。如您发现有侵权的内容,请联系我们。转载请注明出处:https://www.wpsshop.cn/article/detail/46283
推荐阅读
相关标签
  

闽ICP备14008679号