当前位置:   article > 正文

基于51单片机的多功能智能语音循迹避障小车_基于单片机的智能避障小车设计

基于单片机的智能避障小车设计

目录

一.功能介绍及硬件准备

二.电机控制及调速

三.小车循迹方案

四.跟随功能实现

五.测速功能实现

六.OLED显示车速

七.摇头避障功能实现

八.SU-03T语音模块介绍

九.语音切换小车模式+OLED显示模式


一.功能介绍及硬件准备

这是一款基于51单片机开发的智能小车,通过这篇文章我会记录下来开发这款小车的全部过程。这款小车集成了循迹,避障,跟随,语音切换模式选择,并且将可以将车速显示到OLED屏幕上,也可以通过手机app蓝牙操控小车。(注:全文的代码采取分文件编程的写法)

硬件准备

小车底盘一个(两驱),5号4节电池盒一个,51单片机最小系统一个,HC04超声波模块一个,SG90舵机一个,红外避障模块传感器两个,红外光电反射传感器两个,L9110S电机驱动模块(L298n也可以使用),测速传感器一个,SU-03T离线语音模块一个,HC-08蓝牙模块一个,DC-DC电压转换模块两个,0.96寸OLED屏幕一个,杜邦线若干,热熔胶枪一个,也可以再准备一个面包板。


二.电机控制及调速

关于电机控制选用的是L9110s电机驱动模块,在淘宝里也很容易买到,也才不到2块钱,比l298n偏移很,但缺点就是容易发烫。

接线说明:

我们以L9110s电机驱动模块为新手小白讲一下这些模块怎么接线,后面就不多赘述模块如何接线了。模块通常的引脚就是VCC,GND,以及其他的控制或信号引脚。VCC就是模块的电源正极(大多数的模块都是5V供电,具体的参考模块说明书),接到单片机最小系统的VCC引脚上。GND就是模块的负极,接到单片机最小系统的GND引脚上。VCC或GND也可接到通过面包板引出的正负极上。剩下的引脚就接到单片机的IO口上即可。


控制小车前后左右:

控制小车的前后左右运动说白了就是控制两个电机的正反转,两个电机同时正转小车前进,同时反转小车后退,电机一个转一个不转小车实现转向。逻辑非常简单,下面就是L9110s电机驱动模块的真值表,并且该模块可同时控制两个电机。将两个电机的两根线

接入端子中就可以写代码控制了。

IA1输入高电平,IA1输入低电平,【OA1 OB1】电机正转;

IA1输入低电平,IA1输入高电平,【OA1 OB1】电机反转;

IA2输入高电平,IA2输入低电平,【OA2 OB2】电机正转;

IA2输入低电平,IA2输入高电平,【OA2 OB2】电机反转;

motor.c

  1. #include "reg52.h"
  2. sbit RightCon1A = P3^2; //电机A由P3.2,P3.3控制
  3. sbit RightCon1B = P3^3;
  4. sbit LeftCon1A = P3^4; //电机B由P3.4,P3.5控制
  5. sbit LeftCon1B = P3^5;
  6. void goBack() //后退
  7. {
  8. LeftCon1A = 0;
  9. LeftCon1B = 1;
  10. RightCon1A = 0;
  11. RightCon1B = 1;
  12. }
  13. void goRight() //右转
  14. {
  15. LeftCon1A = 0;
  16. LeftCon1B = 1;
  17. RightCon1A = 0;
  18. RightCon1B = 0;
  19. }
  20. void goLeft() //左转
  21. {
  22. LeftCon1A = 0;
  23. LeftCon1B = 0;
  24. RightCon1A = 0;
  25. RightCon1B = 1;
  26. }
  27. void goForward() //前进
  28. {
  29. LeftCon1A = 1;
  30. LeftCon1B = 0;
  31. RightCon1A = 1;
  32. RightCon1B = 0;
  33. }
  34. void stop() //停车
  35. {
  36. LeftCon1A = 0;
  37. LeftCon1B = 0;
  38. RightCon1A = 0;
  39. RightCon1B = 0;
  40. }

蓝牙控制小车

蓝牙控制小车的核心思想就是采用串口中断,用手机app给蓝牙模块发送不同的字符串,单片机接收到字符串后进入串口中断,通过判断字符串内容来控制小车的前后左右。换句话说,蓝牙控制小车不需要配置任何蓝牙模块的相关代码,只需写好串口中断的控制即可实现蓝牙控制。

usart.c

  1. #include "reg52.h"
  2. #include "intrins.h"
  3. #include <string.h>
  4. #include "motor.h"
  5. #define SIZE 12
  6. sfr AUXR = 0x8E;
  7. char buffer[SIZE];
  8. void UartInit(void) //9600bps@11.0592MHz
  9. {
  10. AUXR=0X01;
  11. SCON = 0x50; //配置串口工作方式1,REN使能(REN:串行使能接收位)
  12. TMOD &= 0xF0;
  13. TMOD |=0X20; //设定定时器1工作方式位,8位自动重装载
  14. TL1 = 0xFD; //设定定时器初值
  15. TH1 = 0xFD; //设定定时器初值(波特率9600初值)
  16. ET1 = 0; //紧止定时器1中断
  17. TR1 = 1; //启动定时器1
  18. EA=1; //开启总中断
  19. ES=1; //开始串口中断
  20. }
  21. //发送M1-前进,发送M2-后退,发送M3-左转,发送M4-右转
  22. void Usart_Handler() interrupt 4
  23. {
  24. static int i=0;
  25. char tmp;
  26. if(RI)//接收中断处理
  27. {
  28. RI=0;//清除中断标志位
  29. tmp=SBUF;
  30. if(tmp=='M'){
  31. i=0;
  32. }
  33. buffer[i++]=tmp;
  34. if(buffer[0]=='M'){
  35. switch(buffer[1]){
  36. case'1':
  37. goForward();
  38. break;
  39. case'2':
  40. goBack();
  41. break;
  42. case'3':
  43. goLeft();
  44. break;
  45. case'4':
  46. goRight();
  47. break;
  48. }
  49. }
  50. if(i==12){
  51. memset(buffer,'\0',SIZE); //清空串口接收区
  52. i=0;
  53. }
  54. }
  55. }

小车调速

前面的代码实现的小车的前进都是让小车全速前进,电池的功率有多大小车前进的速度就有多快,6节干电池供电肯定会比四节干电池快的多。那么我们用单片机如何给小车调速,我们用PWM给小车进行调速。 

调速原理:全速前进是LeftCon1A = 0; LeftCon1B = 1;完全停止是LeftCon1A = 0;LeftCon1B = 0;那么单位时间内,比如20ms, 有15ms是全速前进,5ms是完全停止, 速度就会比5ms全速前进,15ms完全停止获得的功率多,相应的速度更快!这就是PWM通过改变占空比调速的原理。

为了更好控制两个电机的不同状态打开两个定时器中断,定时器0控制左边电机,定时器2控制右边电机。使用两组定时器中断调速,这样就可以通过差速的方式控制小车的转向。左轮定时器0调速,右轮定时器1调速,那么左转就是右轮速度大于左轮!

time.c

  1. #include "reg52.h"
  2. #include "motor.h"
  3. char leftspeed;
  4. char cntLeft=0;
  5. char rightspeed;
  6. char cntRight=0;
  7. void Time0Init()
  8. {
  9. //1. 配置定时器0工作模式位16位计时
  10. TMOD = 0x01;
  11. //2. 给初值,定一个0.5出来
  12. TL0=0x33;
  13. TH0=0xFE;
  14. //3. 开始计时
  15. TR0 = 1;
  16. TF0 = 0;
  17. //4. 打开定时器0中断
  18. ET0 = 1;
  19. //5. 打开总中断EA
  20. EA = 1;
  21. }
  22. void Time1Init()
  23. {
  24. //1. 配置定时器1工作模式位16位计时
  25. TMOD &= 0x0F;
  26. TMOD |= 0X1 <<4;
  27. //2. 给初值,定一个0.5出来
  28. TL1=0x33;
  29. TH1=0xFE;
  30. //3. 开始计时
  31. TR1 = 1;
  32. TF1 = 0;
  33. //4. 打开定时器0中断
  34. ET1 = 1;
  35. //5. 打开总中断EA
  36. EA = 1;
  37. }
  38. void Time0Handler() interrupt 1
  39. {
  40. cntLeft++; //统计爆表的次数. cnt=1的时候,报表了1
  41. //重新给初值
  42. TL0=0x33;
  43. TH0=0xFE;
  44. //控制PWM波
  45. if(cntLeft < leftspeed){
  46. goForwardLeft();
  47. }else{
  48. stopLeft();
  49. }
  50. if(cntLeft == 40){//爆表40次,经过了20ms
  51. cntLeft = 0; //当100次表示1s,重新让cnt从0开始,计算下一次的1s
  52. }
  53. }
  54. void Time1Handler() interrupt 3
  55. {
  56. cntRight++; //统计爆表的次数. cnt=1的时候,报表了1
  57. //重新给初值
  58. TL1=0x33;
  59. TH1=0xFE;
  60. //控制PWM波
  61. if(cntRight < rightspeed){
  62. //右前进
  63. goForwardRight();
  64. }else{
  65. //停止
  66. stopRight();
  67. }
  68. if(cntRight == 40){//爆表40次,经过了20ms
  69. cntRight = 0; //当100次表示1s,重新让cnt从0开始,计算下一次的1s
  70. }
  71. }

三.小车循迹方案

循迹模块介绍:

我们选用的是TCRT5000传感器,传感器的红外发射二极管不断发射红外线,当发射出的红外线没有被反射回来或被反射回来但强度不够大时, 红外接收管一直处于关断状态,此时模块的输出端为高电平,指示二极管一直处于熄灭状态 被检测物体出现在检测范围内时,红外线被反射回来且强度足够大,红外接收管饱和, 此时模块的输出端为低电平,指示二极管被点亮。

(注:该模块有一个数字信号输出DO和一个模拟信号输出AO,我们只使用了数字信号DO引脚,AO悬空即可)

总结就是一句话,没反射回来,D0输出高电平,灭灯!

循迹原理:

小车循迹是沿着黑色的线走,由于黑色具有较强的吸收能力,当循迹模块发射的红外线照射到黑线时,红外线将会被黑线吸收,导致循迹模块上光敏三极管处于关闭状态,此时模块上一个LED熄灭。在没有检测到黑线时,模块上两个LED 常亮。

总结就是一句话,有感应到黑线,D0输出高电平 ,灭灯!

小车行驶在直线赛道的时候,两个循迹模块分别是在黑线的两侧,不会吸收发射出的红外线。行驶在圆形赛道的时候,某一侧的循迹模块必然会接触到黑线部分,因此会给单片机一个高电平信号,单片机通过判断是那一侧的循迹模块发出的高电平从而控制小车往那个方向转向。

总结:

走直线时:两个循迹模块都是低电平。

左转时:左模块输出高电平,右模块输出低电平。

右转时:右模块输出高电平,左模块输出低电平。

还需注意的就是这个循迹模块的电压输入是3v-5v,而我们的电池盒提供的电压是6v,虽然不会烧坏模块,但实测的效果会大打折扣,所以使用DC-DC电压模块给循迹模块提供5v的电压。

 

根据上面讲的原理,开始写一个测试代码。

  1. #include <reg52.h>
  2. #include "motor.h"
  3. sbit leftSensor = P2^7; //左循迹模块
  4. sbit rightSensor = P2^6; //右循迹模块
  5. void main()
  6. {
  7. while(1){
  8. if(leftSensor == 0 && rightSensor == 0){
  9. goForward();
  10. }
  11. if(leftSensor == 1 && rightSensor == 0){
  12. goLeft();
  13. }
  14. if(leftSensor == 0 && rightSensor == 1){
  15. goRight();
  16. }
  17. if(leftSensor == 1 && rightSensor == 1){
  18. stop();
  19. }
  20. }
  21. }

循迹模块电位器调节:

经过测试这段代码就可以实现循迹的功能,但是把代码烧录进去之后还需要根据实际情况调节循迹模块上的电位器改变循迹模块的灵敏度。要是发现小车一放下就转圈圈,或者不按照黑线循迹,那么很有可能就是电位器的灵敏度的问题。比如家里地板颜色偏灰,这个时候就要把灵敏度调高。

PWM调速加入实现小车丝滑转弯:

上面的代码虽然已经可以实现循迹的功能,但是在实际测试中发现在转弯的时候一抽一抽。现在就改进一下小车“抽抽” 的这个问题。

上面的代码实现小车转弯的时候,相当于是一种急刹车式的转弯,小车在转弯前丝毫不减速。那么想要让小车丝滑转弯,那么就必须两个轮子都要有速度,而不是通过一个轮子转另一个轮子不转这种方式实现转弯。我们把之前写过的PWM调速的代码加入到循迹的代码中即可实现丝滑转弯。

  1. #include "motor.h"
  2. #include "usart.h"
  3. #include "time.h"
  4. #include <reg52.h>
  5. /*
  6. leftspeed,rightspeed这两个参数具体给多大
  7. 根据小车跑动情况来随时修改
  8. */
  9. sbit leftSensor = P2^7; //左循迹模块
  10. sbit rightSensor = P2^6;//右循迹模块
  11. extern char leftspeed;
  12. extern char rightspeed;
  13. void main()
  14. {
  15. Time0Init();
  16. Time1Init();
  17. while(1){
  18. if(leftSensor == 0 && rightSensor == 0){
  19. leftspeed = 40;
  20. rightspeed = 40;
  21. }
  22. if(leftSensor == 1 && rightSensor == 0){
  23. leftspeed = 15;
  24. rightspeed = 40; //右轮速度大于左轮,右转
  25. }
  26. if(leftSensor == 0 && rightSensor == 1){
  27. leftspeed = 40; //左轮速度大于右轮,右转
  28. rightspeed = 15;
  29. }
  30. if(leftSensor == 1 && rightSensor == 1){
  31. leftspeed = 0;
  32. rightspeed = 0;
  33. }
  34. }
  35. }

实测可能会遇到的问题:

1.直线跑不直:在跑直线的时候可能跑着跑着就越来越斜的这种情况,这种情况的原因就是两个电机的速度不一致导致的。解决方法就是把转的快的那一边的电机速度一点一点给它调慢,直到小车彻底跑直为止。

2.转弯时跑出赛道:这个情况的出现就是转弯的时候电机转速不够,提高相应的电机转速即可。


四.跟随功能实现

原理和寻线是一样的,寻线红外观朝下,跟随朝前。用到的也是两个红外模块只不过发射管的位置不一样而已。

跟随小车的原理:

左边跟随模块能返回红外,输出低电平,右边不能返回,输出高电平,说明物体在左边,需要左转 右边跟随模块能返回红外,输出低电平,左边不能返回,输出高电平,说明物体在右边,需要右转

跟随代码如下:

  1. #include "motor.h"
  2. #include "reg52.h"
  3. sbit leftSensor = P2^5;
  4. sbit rightSensor = P2^4;
  5. void main()
  6. {
  7. while(1){
  8. if(leftSensor == 0 && rightSensor == 0){
  9. goForward();
  10. }
  11. if(leftSensor == 1 && rightSensor == 0){
  12. goRight();
  13. }
  14. if(leftSensor == 0 && rightSensor == 1){
  15. goLeft();
  16. }
  17. if(leftSensor == 1 && rightSensor == 1){
  18. stop();
  19. }
  20. }
  21. }

五.测速功能实现

模块介绍:

用途:广泛用于电机转速检测,脉冲计数,位置限位等。

有遮挡,输出高电平;无遮挡,输出低电平

接线 VCC 接电源正极3.3-5V

GND 接电源负极

DO TTL开关信号输出

AO 此模块不起作用

安装位置如图所示:

  

测速原理:

轮子走一圈,经过一个周长,C = 2x3.14x半径= 3.14 x 轮子直径(6.5cm),对应的码盘也转一圈,码盘有20个格子,每经过一个格子,会遮挡(高电平)和不遮挡(低电平),那么码盘一小格就是对应走了 3.14 * 6.5 cm /20 = 1.0205CM。换句话说就是一个脉冲就是走了1.0205CM。定时器可以设计成一秒,统计脉冲数,假设一秒有80脉冲,那么就是80cm/s。

代码逻辑:

接下来我们编程实现将车速通过串口发送给串口助手,也可以使用蓝牙模块发送到手机app上。我们先发送到串口助手上看看效果。

time.c

  1. #include <REGX52.H>
  2. unsigned int cnt = 0;
  3. extern unsigned int rightspeedCnt;
  4. extern unsigned int leftspeedCnt;
  5. unsigned int speedleft;
  6. unsigned int speedright;
  7. char singal;
  8. void Time0Init()
  9. {
  10. //1. 配置定时器0工作模式位16位计时
  11. TMOD = 0x01;
  12. //2. 给初值,定一个0.5ms出来
  13. TL0=0x33;
  14. TH0=0xFE;
  15. //3. 开始计时
  16. TR0 = 1;
  17. TF0 = 0;
  18. //4. 打开定时器0中断
  19. ET0 = 1;
  20. //5. 打开总中断EA
  21. EA = 1;
  22. }
  23. void Time0Handler() interrupt 1
  24. {
  25. cnt++; //统计爆表的次数. cnt=1的时候,报表了1
  26. //重新给初值
  27. TL0=0x33;
  28. TH0=0xFE;
  29. if(cnt == 2000){//爆表2000次,经过了1s
  30. {
  31. cnt=0;
  32. singal=1;
  33. speedright = rightspeedCnt; //计算小车的速度,也就是拿到speedCnt的值
  34. speedleft = leftspeedCnt;
  35. rightspeedCnt=0;
  36. leftspeedCnt=0;//1秒后拿到speedCnt个格子,就能算出这1s的速度,格子清零
  37. }
  38. }
  39. }

usart.c

  1. #include "reg52.h"
  2. #include "intrins.h"
  3. #include <string.h>
  4. void UartInit(void) //9600bps@11.0592MHz
  5. {
  6. SCON = 0x50; //配置串口工作方式1,REN使能接收
  7. TMOD &= 0x0F;
  8. TMOD |= 0x20;//定时器1工作方式位8位自动重装
  9. TH1 = 0xFD;
  10. TL1 = 0xFD;//9600波特率的初值
  11. TR1 = 1;//启动定时器
  12. EA = 1;//开启总中断
  13. }
  14. void SendByte(char mydata)//发送字符
  15. {
  16. SBUF = mydata;
  17. while(!TI);
  18. TI=0;
  19. }
  20. void SendString(char *str)//发送字符串
  21. {
  22. while(*str != '\0'){
  23. SendByte(*str);
  24. str++;
  25. }
  26. }

main.c

  1. #include "motor.h"
  2. #include "usart.h"
  3. #include "reg52.h"
  4. #include "time.h"
  5. #include "stdio.h"
  6. sbit speedIO1 = P3^2;//外部中断0
  7. sbit speedIO2 = P3^3;//外部中断1
  8. unsigned int leftspeedCnt = 0; //统计左轮格子,脉冲次数
  9. unsigned int rightspeedCnt = 0; //统计右轮格子,脉冲次数
  10. extern unsigned int speedleft; //左轮速度
  11. extern unsigned int speedright; //右轮速度
  12. extern char singal; //发送速度的信号
  13. char SpeedMes_R[24]; //主程序发送右轮速度数据的字符串缓冲区
  14. char SpeedMes_L[24]; //主程序发送左轮速度数据的字符串缓冲区
  15. void Ex0Init()
  16. {
  17. EX0 = 1;//允外部中断
  18. IT0 = 1;//外部中断的下降沿触发
  19. }
  20. void Ex1Init()
  21. {
  22. EX1 = 1;//允外部中断
  23. IT1 = 1;//外部中断的下降沿触发
  24. }
  25. void main()
  26. {
  27. Time0Init();//定时器0初始化
  28. UartInit();//串口相关初始化
  29. Ex0Init();//外部中断初始化
  30. Ex1Init();
  31. while(1){
  32. if(singal){
  33. sprintf(SpeedMes_R,"rightspeed:%d cm/s",speedright);//串口数据的字符串拼装,speed是格子,每个格子1cm
  34. SendString(SpeedMes_R);//速度发出去
  35. SendString("\r\n");
  36. sprintf(SpeedMes_L,"leftspeed:%d cm/s",speedleft);//串口数据的字符串拼装,speed是格子,每个格子1cm
  37. SendString(SpeedMes_L);//速度发出去
  38. SendString("\r\n");
  39. singal = 0;//清0speed,下次由定时器1s后的中断处理中再置一
  40. }
  41. }
  42. }
  43. void rightspeedHandler() interrupt 0 //外部中断处理函数
  44. {
  45. rightspeedCnt++; //每经过一共格子,加一
  46. }
  47. void leftspeedHandler() interrupt 2 //外部中断处理函数
  48. {
  49. leftspeedCnt++; //每经过一共格子,加一
  50. }

六.OLED显示车速

车速可以再上位机中显示了,接下来我们将车速显示到OLED屏幕上。使用OLED屏幕需要先了解IIC或者SPI的协议,我使用的0.96寸IIC协议的OLED屏幕。这里就不多赘述OLED屏幕的使用和IIC协议了,我之前也写过有关IIC和OLED屏幕相关的文章,感兴趣的小伙伴可以去看一下。不想深究OLED原理的也可以直接拿厂家提供的代码直接使用。

由于OLED相关的代码过于冗长,就不在文章里展示了,我主页里的资源有这个小车的完整代码,我们主要展示主函数代码以及汉字取模软件的使用。

取模软件使用:

输入显示的文字

 

 按下Ctrl+Enter,选择C51格式

文字的代码随即生成

本来是想用汉字显示到屏幕中,但是16*16的汉字显示的话屏幕太小了,后面的车速的内容就放不下了,所以最后决定用英文显示。这样的话就用不上取模软件了,直接在程序里面包含厂家提供的英文字模库即可。

main.c

  1. #include "motor.h"
  2. #include "usart.h"
  3. #include "reg52.h"
  4. #include "time.h"
  5. #include "stdio.h"
  6. #include "OLED.h"
  7. sbit speedIO1 = P3^2;//外部中断0
  8. sbit speedIO2 = P3^3;//外部中断1
  9. unsigned int leftspeedCnt = 0; //统计左轮格子,脉冲次数
  10. unsigned int rightspeedCnt = 0; //统计右轮格子,脉冲次数
  11. extern unsigned int speedleft; //左轮速度
  12. extern unsigned int speedright; //右轮速度
  13. extern char singal; //发送速度的信号
  14. char SpeedMes_R[24]; //主程序发送右轮速度数据的字符串缓冲区
  15. char SpeedMes_L[24]; //主程序发送左轮速度数据的字符串缓冲区
  16. void Ex0Init()
  17. {
  18. EX0 = 1;//允外部中断
  19. IT0 = 1;//外部中断的下降沿触发
  20. }
  21. void Ex1Init()
  22. {
  23. EX1 = 1;//允外部中断
  24. IT1 = 1;//外部中断的下降沿触发
  25. }
  26. void main()
  27. {
  28. Time0Init();//定时器0初始化
  29. UartInit();//串口相关初始化
  30. Ex0Init();//外部中断0初始化
  31. Ex1Init();//外部中断1初始化
  32. Oled_Init();//OLED初始化
  33. Oled_Clear();//清屏
  34. while(1){
  35. if(singal){
  36. sprintf(SpeedMes_R,"R-speed:%d cm/s",speedright);//串口数据的字符串拼装,speed是格子,每个格子1cm
  37. SendString(SpeedMes_R);//速度发出去
  38. SendString("\r\n");
  39. sprintf(SpeedMes_L,"L-speed:%d cm/s",speedleft);//串口数据的字符串拼装,speed是格子,每个格子1cm
  40. SendString(SpeedMes_L);//速度发出去
  41. SendString("\r\n");
  42. singal = 0;//清0speed,下次由定时器1s后的中断处理中再置一
  43. }
  44. Oled_Show_Str(1,1,SpeedMes_L); //显示左轮速度
  45. Oled_Show_Str(2,1,SpeedMes_R); //显示右轮速度
  46. }
  47. }
  48. void rightspeedHandler() interrupt 0 //外部中断处理函数
  49. {
  50. rightspeedCnt++; //每经过一共格子,加一
  51. }
  52. void leftspeedHandler() interrupt 2 //外部中断处理函数
  53. {
  54. leftspeedCnt++; //每经过一共格子,加一
  55. }

七.摇头避障功能实现

避障功能是实现用的是超声波模块,其原理是通过发送和收超声波,利用时间差和声音传播速度, 计算出模块到前方障碍物的距离。当检测到小于指定距离时,小车停止。

怎么让它发送波:Trig给Trig端口至少10us的高电平

怎么知道它开始发了 Echo信号:由低电平跳转到高电平,表示开始发送波

怎么知道接收了返回波 Echo:由高电平跳转回低电平,表示波回来了

怎么算时间:Echo引脚维持高电平的时间! 波发出去的那一下,开始启动定时器 波回来的拿一下,我们开始停止定时器,计算出中间经过多少时间

怎么算距离:距离 = 速度 (340m/s)* 时间/2

Hc04.c

  1. #include "reg52.h"
  2. #include "delay.h"
  3. sbit Trig = P2^3;
  4. sbit Echo = P2^2;
  5. void Time1Init()
  6. {
  7. TMOD &= 0x0F; //设置定时器模式
  8. TMOD |= 0x10;
  9. TH1 = 0;
  10. TL1 = 0;
  11. //设置定时器0工作模式1,初始值设定0开始数数,不着急启动定时器
  12. }
  13. void startHC() //发送超声波
  14. {
  15. Trig = 0;
  16. Trig = 1;
  17. Delay10us();
  18. Trig = 0;
  19. }
  20. double get_distance() //获取距离
  21. {
  22. double time;
  23. //定时器数据清零,以便下一次测距
  24. TH1 = 0;
  25. TL1 = 0;
  26. //1. Trig ,给Trig端口至少10us的高电平
  27. startHC();
  28. //2. echo由低电平跳转到高电平,表示开始发送波
  29. while(Echo == 0);
  30. //波发出去的那一下,开始启动定时器
  31. TR1 = 1;
  32. //3. 由高电平跳转回低电平,表示波回来了
  33. while(Echo == 1);
  34. //波回来的那一下,我们开始停止定时器
  35. TR1 = 0;
  36. //4. 计算出中间经过多少时间
  37. time = (TH1 * 256 + TL1)*1.085;//us为单位
  38. //5. 距离 = 速度 (340m/s)* 时间/2
  39. return (time * 0.017);
  40. }

摇头功能使用舵机实现

怎么控制舵机

向黄色信号线“灌入”PWM信号,PWM波的频率不能太高,大约50HZ,即周期=1/频率=1/50=0.02s,20ms左右

0.5ms-------------0度; 2.5% 对应函数中占空比为250

1.0ms------------45度; 5.0% 对应函数中占空比为500

1.5ms------------90度; 7.5% 对应函数中占空比为750

2.0ms-----------135度; 10.0% 对应函数中占空比为1000

2.5ms-----------180度; 12.5% 对应函数中占空比为125

SG90.c

  1. #include "reg52.h"
  2. #include "delay.h"
  3. sbit sg90_con = P1^1;
  4. int jd; //定义角度
  5. int cnt = 0;
  6. void Time0Init()
  7. {
  8. //1. 配置定时器0工作模式位16位计时
  9. TMOD &= 0xF0; //设置定时器模式
  10. TMOD |= 0x01;
  11. //2. 给初值,定一个0.5出来
  12. TL0=0x33;
  13. TH0=0xFE;
  14. //3. 开始计时
  15. TR0 = 1;
  16. TF0 = 0;
  17. //4. 打开定时器0中断
  18. ET0 = 1;
  19. //5. 打开总中断EA
  20. EA = 1;
  21. }
  22. void SG90_Middle()
  23. {
  24. //中间位置
  25. jd = 3; //90度 1.5ms高电平
  26. cnt = 0;
  27. }
  28. void SG90_Right()
  29. {
  30. //右边位置
  31. jd = 1; //0度
  32. cnt = 0;
  33. }
  34. void SG90_Left()
  35. {
  36. //左边位置
  37. jd = 5; //135度
  38. cnt = 0;
  39. }
  40. void Time0Handler() interrupt 1
  41. {
  42. cnt++; //统计爆表的次数. cnt=1的时候,报表了1
  43. //重新给初值
  44. TL0=0x33;
  45. TH0=0xFE;
  46. //控制PWM波
  47. if(cnt < jd){
  48. sg90_con = 1;
  49. }else{
  50. sg90_con = 0;
  51. }
  52. if(cnt == 40){//爆表40次,经过了20ms
  53. cnt = 0; //当100次表示1s,重新让cnt从0开始,计算下一次的1s
  54. sg90_con = 1;
  55. }
  56. }

注意:如果舵机电压低于额定电压时,舵机可能会疯狂地不受控制的摇头,供电正常后这个问题就可以解决。(一开始我还以为是舵机坏了)

八.SU-03T语音模块介绍

接下来进入小车的最后一个阶段,语音控制。选用的是SU-03T这款语音模块,这款模块对小白特别友好,无需编程,不需要二次开发,通过厂家给的网站配置后即可使用,傻瓜式操作。而且这款模块的识别还是非常灵敏的,前端的界面设计的也非常好用。

 SU-03T语音模块配置:
智能公元/AIOT快速产品化平台​​​​​​http://www.smartpi.cn/#/

登录厂家所提供的开发平台,点击创建产品->其它产品

选择纯离线 方案

 

 选择我们使用的SU-03T

 填写好产品名称,语言选择中文,如何点击保存。

接下来就进入了我们的配置界面,我们选择三个IO口分别切换我们的循迹模式,跟随模式,避障模式。把语音模块的三个IO口都设置为高电平

接着配置语音模块的唤醒词,这里可以多配置几条,并且可以设置灵敏度。

接着再定义应答语,根据自己的功能定义。

接着再设置每种词条的命令,我设置的是当说出某种词条的时候指定的IO口输出低电平。

然后其余的设置都比较简单,根据自己的爱好选择音调,语速之类的。

点击生成后就等待生成,大约半个小时左右。

生成完之后点击下载SDK,后续烧录的过程参考厂家提供的资料即可,我都会跟这个项目的源代码放在一起。

九.语音切换小车模式+OLED显示模式

语音模块的加入是我们实现的最后一个功能,也是我们之前所有功能的一个大汇总,所有的功能都是基于我们前面写过的代码。但是在实现这个功能之前我有一点需要强调。由于51单片机只有两组定时器,而我们的许多功能都用到了定时器,比如测速,电机调速,舵机,超声波避障。因此我们没有多余的定时器去分配给这么多功能,因此最后这个“大杂烩”小车我们选择抛弃测速,电机调速这两个功能。倘若选用更强大的MCU比如STM32就不存在这种取舍问题。

小车总体功能:当说出“进入循迹模式”,小车会进入循迹模式。说出“进入跟随模式”,小车会进入跟随模式。说出“进入避障模式”,小车会进入避障模式。并且OLED屏幕上会显示小车的模式。

OLED.c

  1. #include "reg52.h"
  2. #include "intrins.h"
  3. #include "Oledfont.h"
  4. sbit scl = P1^2;
  5. sbit sda = P1^3;
  6. void IIC_Start()
  7. {
  8. scl = 0;
  9. sda = 1;
  10. scl = 1;
  11. _nop_();
  12. sda = 0;
  13. _nop_();
  14. }
  15. void IIC_Stop()
  16. {
  17. scl = 0;
  18. sda = 0;
  19. scl = 1;
  20. _nop_();
  21. sda = 1;
  22. _nop_();
  23. }
  24. char IIC_ACK()
  25. {
  26. char flag;
  27. sda = 1;//就在时钟脉冲9期间释放数据线
  28. _nop_();
  29. scl = 1;
  30. _nop_();
  31. flag = sda;
  32. _nop_();
  33. scl = 0;
  34. _nop_();
  35. return flag;
  36. }
  37. void IIC_Send_Byte(char dataSend)
  38. {
  39. int i;
  40. for(i = 0;i<8;i++){
  41. scl = 0;//scl拉低,让sda做好数据准备
  42. sda = dataSend & 0x80;//1000 0000获得dataSend的最高位,给sda
  43. _nop_();//发送数据建立时间
  44. scl = 1;//scl拉高开始发送
  45. _nop_();//数据发送时间
  46. scl = 0;//发送完毕拉低
  47. _nop_();//
  48. dataSend = dataSend << 1;
  49. }
  50. }
  51. void Oled_Write_Cmd(char dataCmd)
  52. {
  53. // 1. start()
  54. IIC_Start();
  55. //
  56. // 2. 写入从机地址 b0111 1000 0x78
  57. IIC_Send_Byte(0x78);
  58. // 3. ACK
  59. IIC_ACK();
  60. // 4. cotrol byte: (0)(0)000000 写入命令 (0)(1)000000写入数据
  61. IIC_Send_Byte(0x00);
  62. // 5. ACK
  63. IIC_ACK();
  64. //6. 写入指令/数据
  65. IIC_Send_Byte(dataCmd);
  66. //7. ACK
  67. IIC_ACK();
  68. //8. STOP
  69. IIC_Stop();
  70. }
  71. void Oled_Write_Data(char dataData)
  72. {
  73. // 1. start()
  74. IIC_Start();
  75. //
  76. // 2. 写入从机地址 b0111 1000 0x78
  77. IIC_Send_Byte(0x78);
  78. // 3. ACK
  79. IIC_ACK();
  80. // 4. cotrol byte: (0)(0)000000 写入命令 (0)(1)000000写入数据
  81. IIC_Send_Byte(0x40);
  82. // 5. ACK
  83. IIC_ACK();
  84. ///6. 写入指令/数据
  85. IIC_Send_Byte(dataData);
  86. //7. ACK
  87. IIC_ACK();
  88. //8. STOP
  89. IIC_Stop();
  90. }
  91. void Oled_Init(void){
  92. Oled_Write_Cmd(0xAE);//--display off
  93. Oled_Write_Cmd(0x00);//---set low column address
  94. Oled_Write_Cmd(0x10);//---set high column address
  95. Oled_Write_Cmd(0x40);//--set start line address
  96. Oled_Write_Cmd(0xB0);//--set page address
  97. Oled_Write_Cmd(0x81); // contract control
  98. Oled_Write_Cmd(0xFF);//--128
  99. Oled_Write_Cmd(0xA1);//set segment remap
  100. Oled_Write_Cmd(0xA6);//--normal / reverse
  101. Oled_Write_Cmd(0xA8);//--set multiplex ratio(1 to 64)
  102. Oled_Write_Cmd(0x3F);//--1/32 duty
  103. Oled_Write_Cmd(0xC8);//Com scan direction
  104. Oled_Write_Cmd(0xD3);//-set display offset
  105. Oled_Write_Cmd(0x00);//
  106. Oled_Write_Cmd(0xD5);//set osc division
  107. Oled_Write_Cmd(0x80);//
  108. Oled_Write_Cmd(0xD8);//set area color mode off
  109. Oled_Write_Cmd(0x05);//
  110. Oled_Write_Cmd(0xD9);//Set Pre-Charge Period
  111. Oled_Write_Cmd(0xF1);//
  112. Oled_Write_Cmd(0xDA);//set com pin configuartion
  113. Oled_Write_Cmd(0x12);//
  114. Oled_Write_Cmd(0xDB);//set Vcomh
  115. Oled_Write_Cmd(0x30);//
  116. Oled_Write_Cmd(0x8D);//set charge pump enable
  117. Oled_Write_Cmd(0x14);//
  118. Oled_Write_Cmd(0xAF);//--turn on oled panel
  119. }
  120. void Oled_Clear()
  121. {
  122. unsigned char i,j; //-128 --- 127
  123. for(i=0;i<8;i++){
  124. Oled_Write_Cmd(0xB0 + i);//page0--page7
  125. //每个page从0列
  126. Oled_Write_Cmd(0x00);
  127. Oled_Write_Cmd(0x10);
  128. //0到127列,依次写入0,每写入数据,列地址自动偏移
  129. for(j = 0;j<128;j++){
  130. Oled_Write_Data(0);
  131. }
  132. }
  133. }
  134. void Oled_Show_Char(char row,char col,char oledChar){ //row*2-2
  135. unsigned int i;
  136. Oled_Write_Cmd(0xb0+(row*2-2)); //page 0
  137. Oled_Write_Cmd(0x00+(col&0x0f)); //low
  138. Oled_Write_Cmd(0x10+(col>>4)); //high
  139. for(i=((oledChar-32)*16);i<((oledChar-32)*16+8);i++){
  140. Oled_Write_Data(F8X16[i]); //写数据oledTable1
  141. }
  142. Oled_Write_Cmd(0xb0+(row*2-1)); //page 1
  143. Oled_Write_Cmd(0x00+(col&0x0f)); //low
  144. Oled_Write_Cmd(0x10+(col>>4)); //high
  145. for(i=((oledChar-32)*16+8);i<((oledChar-32)*16+8+8);i++){
  146. Oled_Write_Data(F8X16[i]); //写数据oledTable1
  147. }
  148. }
  149. /******************************************************************************/
  150. // 函数名称:Oled_Show_Char
  151. // 输入参数:oledChar
  152. // 输出参数:无
  153. // 函数功能:OLED显示单个字符
  154. /******************************************************************************/
  155. void Oled_Show_Str(char row,char col,char *str){
  156. while(*str!=0){
  157. Oled_Show_Char(row,col,*str);
  158. str++;
  159. col += 8;
  160. }
  161. }

main.c

  1. #include "reg52.h"
  2. #include "hc04.h"
  3. #include "delay.h"
  4. #include "sg90.h"
  5. #include "motor.h"
  6. #include "oled.h"
  7. #define Middle 0 //定义舵机状态标志位
  8. #define Left 1
  9. #define Right 2
  10. #define Following 1
  11. #define Tracking 2
  12. #define Avioding 3 //定义模式状态标志位
  13. //语音模块引脚定义
  14. sbit A25 = P1^5; //跟随模式
  15. sbit A26 = P1^6; //避障模式
  16. sbit A27 = P1^7; //循迹模式
  17. //跟随红外模块引脚定义
  18. sbit Fol_leftSensor = P2^5;
  19. sbit Fol_rightSensor = P2^4;
  20. //循迹模块引脚定义
  21. sbit Tra_leftSensor = P0^1;
  22. sbit Tra_rightSensor = P0^2;
  23. char dir;
  24. double M_distance; //正前方距离
  25. double L_distance; //左侧距离
  26. double R_distance; //右侧距离
  27. //跟随模式
  28. void Following_Mode()
  29. {
  30. if(Fol_leftSensor == 0 && Fol_rightSensor == 0){
  31. goForward();
  32. }
  33. if(Fol_leftSensor == 1 && Fol_rightSensor == 0){
  34. goRight();
  35. }
  36. if(Fol_leftSensor == 0 && Fol_rightSensor == 1){
  37. goLeft();
  38. }
  39. if(Fol_leftSensor == 1 && Fol_rightSensor == 1){
  40. stop();
  41. }
  42. }
  43. //循迹模式
  44. void Tracking_Mode()
  45. {
  46. if(Tra_leftSensor == 0 && Tra_rightSensor == 0){
  47. goForward();
  48. }
  49. if(Tra_leftSensor == 1 && Tra_rightSensor == 0){
  50. goLeft();
  51. }
  52. if(Tra_leftSensor == 0 && Tra_rightSensor == 1){
  53. goRight();
  54. }
  55. if(Tra_leftSensor == 1 && Tra_rightSensor == 1){
  56. stop();
  57. }
  58. }
  59. //避障模式
  60. void Avioding_Mode()
  61. {
  62. if(dir != Middle){
  63. SG90_Middle();
  64. dir = Middle;
  65. Delay300ms();
  66. }
  67. M_distance = get_distance();
  68. if(M_distance > 25){
  69. goForward();//前进
  70. }else if(M_distance < 10){
  71. goBack();//距离过小时后退
  72. }
  73. else{
  74. stop();
  75. SG90_Left();
  76. Delay300ms();
  77. L_distance = get_distance();
  78. SG90_Middle();
  79. Delay300ms();
  80. SG90_Right();
  81. Delay300ms();
  82. R_distance = get_distance();
  83. dir = Right;
  84. if(L_distance < R_distance){
  85. goRight();
  86. }
  87. if(L_distance > R_distance){
  88. goLeft();
  89. }
  90. }
  91. }
  92. void main()
  93. {
  94. int mark = 0;
  95. Time0Init();
  96. Time1Init();
  97. //舵机的初始位置
  98. SG90_Middle();
  99. Delay300ms();
  100. Oled_Init();//OLED初始化
  101. Oled_Clear();//清屏
  102. Oled_Show_Str(2,2,"-----Ready----");
  103. while(1){
  104. //满足避障模式的条件
  105. if(A26 == 0 && A25 == 1 && A27 == 1){
  106. if(mark!=Avioding){
  107. Oled_Clear();
  108. Oled_Show_Str(2,2,"Avioding_Mode");
  109. }
  110. mark = Avioding;
  111. Avioding_Mode();
  112. }
  113. //满足跟随模式的条件
  114. if(A26 == 1 && A25 == 0 && A27 == 1){
  115. if(mark!=Following){
  116. Oled_Clear();
  117. Oled_Show_Str(2,2,"Following_Mode");
  118. }
  119. mark = Following;
  120. Following_Mode();
  121. }
  122. //满足循迹模式的条件
  123. if(A26 == 1 && A25 == 1 && A27 == 0){
  124. if(mark!=Tracking){
  125. Oled_Clear();
  126. Oled_Show_Str(2,2,"Tracking_Mode");
  127. }
  128. mark = Tracking;
  129. Tracking_Mode();
  130. }
  131. }
  132. }

 

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

闽ICP备14008679号