devbox
weixin_40725706
这个屌丝很懒，什么也没留下！
关注作者
热门标签
热门文章
当前位置:   article > 正文

基于C51语音控制小车_ci-03t1工作原理

作者：weixin_40725706 | 2024-05-05 16:57:45

赞

踩

ci-03t1工作原理

目录

前期准备：

SU-03T

电机模块

循迹小车原理

跟随小车/壁障小车

超声波测距

SG90舵机开发

舵机基本介绍

项目

前期准备：

SU-03T

网盘资料
https://pan.baidu.com/s/1dXQSla_8D5O3D7UCsHZ0Dw 提取码 3k5a
这个语音模块不需要编程，不需要二次开发
通过厂家给的网站配置后即可使用，傻瓜式操作，
把A25 26 27设置为高电平

 通过接入C51串口来查看高低电压，进行语音控制

电机模块

L9110s 概述
IA1 输入高电平， IA1 输入低电平，【 OA1 OB1 】电机正转；
IA1 输入低电平， IA1 输入高电平，【 OA1 OB1 】电机反转；
IA2 输入高电平， IA2 输入低电平，【 OA2 OB2 】电机正转；
IA2 输入低电平， IA2 输入高电平，【 OA2 OB2 】电机反转；

和上官一号的接线

循迹模块 

TCRT5000传感器的红外发射二极管不断发射红外线
当发射出的红外线没有被反射回来或被反射回来但强度不够大时，
红外接收管一直处于关断状态，此时模块的输出端为高电平，指示二极管一直处于熄灭状态
被检测物体出现在检测范围内时，红外线被反射回来且强度足够大，红外接收管饱和，
此时模块的输出端为低电平，指示二极管被点亮
总结就是一句话，没反射回来， D0 输出高电平 ，灭灯
接线方式
VCC: 接电源正极（ 3-5V ）
GND: 接电源负极
DO:TTL 开关信号输出 0 、 1
AO: 模拟信号输出 ( 不同距离输出不同的电压，此脚一般可以不接）

循迹小车原理

由于黑色具有较强的吸收能力，当循迹模块发射的红外线照射到黑线时，红外线将会被黑线吸收，导致循迹模块上光敏三极管处于关闭状态，此时模块上一个LED 熄灭。在没有检测到黑线时，模块上两个 LED 常亮
总结就是一句话，有感应到黑线， D0 输出高电平 ，灭灯
循迹模块安装在小车车头两侧 下方小车两个模块都能反射回来红外，输出低电平，灯亮，直走
上方小车左模块遇到黑线，红外被吸收，左模块输出高电平，右模块输出低电平，左转，反之右转

跟随小车/壁障小车

红外壁障模块分析

原理和寻线是一样的，寻线红外观朝下，跟随朝前

跟随小车的原理  

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

超声波测距

测距原理基本说明

超声波测距模块是用来测量距离的一种产品，通过发送和收超声波，利用时间差和声音传播速度，
计算出模块到前方障碍物的距离

型号：HC-SR04
接线参考：模块除了两个电源引脚外，还有TRIG，ECHO引脚 

怎么让它发波
 Trig，给Trig端口至少10us的高电平
 
怎么知道开始发了
Echo信号，由低电平跳转到高电平，表示开始发送波

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

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

怎么算距离
距离=速度（340m/s）*时间/2

时序

SG90舵机开发

舵机基本介绍

如下图所示，最便宜的舵机sg90，常用三根或者四根接线，黄色为PWM信号控制用处：垃圾桶项目开盖
用、智能小车的全比例转向、摄像头云台、机械臂等
常见的有0-90°、0-180°、0-360°

怎么控制转角

向黄色信号线“灌入”PWM信号。
PWM波的频率不能太高，50hz，即周期=1/频率=1/50=0.02s，20ms左右数据：
不同的PWM波形对应不同的旋转角度，以20ms为周期，50hz为频率的PWM波 

 

项目

motor.c文件

  1. #include "reg52.h"
  2.  
  3. sbit RightCon1A = P3^7;
  4. sbit RightCon1B = P3^3;
  5.  
  6. sbit LeftCon1A = P3^4;
  7. sbit LeftCon1B = P3^5;
  8.  
  9. void goForward()
  10. {
  11.     LeftCon1A = 0;
  12.     LeftCon1B = 1;
  13.      
  14.     RightCon1A = 0;
  15.     RightCon1B = 1;
  16. }
  17.  
  18. void goRight()
  19. {
  20.     LeftCon1A = 0;
  21.     LeftCon1B = 1;
  22.      
  23.     RightCon1A = 0;
  24.     RightCon1B = 0;
  25. }
  26.  
  27.  
  28. void goLeft()
  29. {
  30.     LeftCon1A = 0;
  31.     LeftCon1B = 0;
  32.      
  33.     RightCon1A = 0;
  34.     RightCon1B = 1;
  35. }
  36.  
  37. void goBack()
  38. {
  39.     LeftCon1A = 1;
  40.     LeftCon1B = 0;
  41.      
  42.     RightCon1A = 1;
  43.     RightCon1B = 0;
  44. }
  45.  
  46. void stop()
  47. {
  48.     LeftCon1A = 0;
  49.     LeftCon1B = 0;
  50.      
  51.     RightCon1A = 0;
  52.     RightCon1B = 0;
  53. }

motor.h文件

  1. void goRight();
  2. void goLeft();
  3. void goForward();
  4. void goBack();
  5. void stop();

delay.c文件

  1. #include "intrins.h"
  2.  
  3. void Delay2000ms()      //@11.0592MHz
  4. {
  5.     unsigned char i, j, k;
  6.  
  7.     i = 15;
  8.     j = 2;
  9.     k = 235;
  10.     do
  11.     {
  12.         do
  13.         {
  14.             while (--k);
  15.         } while (--j);
  16.     } while (--i);
  17. }
  18.  
  19.  
  20. void Delay10us()        //@11.0592MHz
  21. {
  22.     unsigned char i;
  23.  
  24.     i = 2;
  25.     while (--i);
  26. }
  27.  
  28. void Delay300ms()       //@11.0592MHz
  29. {
  30.     unsigned char i, j, k;
  31.  
  32.     _nop_();
  33.     i = 3;
  34.     j = 26;
  35.     k = 223;
  36.     do
  37.     {
  38.         do
  39.         {
  40.             while (--k);
  41.         } while (--j);
  42.     } while (--i);
  43. }
  44.  
  45.  
  46. void Delay150ms()       //@11.0592MHz
  47. {
  48.     unsigned char i, j, k;
  49.  
  50.     i = 2;
  51.     j = 13;
  52.     k = 237;
  53.     do
  54.     {
  55.         do
  56.         {
  57.             while (--k);
  58.         } while (--j);
  59.     } while (--i);
  60. }
  61.  
  62. void Delay450ms()       //@11.0592MHz
  63. {
  64.     unsigned char i, j, k;
  65.  
  66.     _nop_();
  67.     i = 4;
  68.     j = 39;
  69.     k = 209;
  70.     do
  71.     {
  72.         do
  73.         {
  74.             while (--k);
  75.         } while (--j);
  76.     } while (--i);
  77. }

delay.h文件

  1. void Delay2000ms();     //@11.0592MHz
  2.  
  3.  
  4. void Delay10us();       //@11.0592MHz
  5.  
  6. void Delay150ms();
  7.  
  8. void Delay450ms();  
  9. void Delay300ms();

hc04.c文件

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

hc04.h文件

  1. double get_distance();
  2. void Time1Init();

Oled.c文件

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

Oled.h文件

  1. void Oled_Write_Cmd(char dataCmd);
  2. void Oled_Write_Data(char dataData);
  3. void Oled_Init(void);
  4. void Oled_Clear();
  5. void Oled_Show_Str(char row,char col,char *str);

sg90.c文件

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

sg90.h文件

  1. void Time0Init();
  2.  
  3.  
  4. void sgMiddle();
  5.  
  6. void sgRight();
  7.  
  8.  
  9. void sgLeft();

Oledfont.h文件

  1. const unsigned char code F8X16[]=     
  2. {
  3.   0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,// 0
  4.   0x00,0x00,0x00,0xF8,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x33,0x30,0x00,0x00,0x00,//! 1
  5.   0x00,0x10,0x0C,0x06,0x10,0x0C,0x06,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,//" 2
  6.   0x40,0xC0,0x78,0x40,0xC0,0x78,0x40,0x00,0x04,0x3F,0x04,0x04,0x3F,0x04,0x04,0x00,//# 3
  7.   0x00,0x70,0x88,0xFC,0x08,0x30,0x00,0x00,0x00,0x18,0x20,0xFF,0x21,0x1E,0x00,0x00,//$ 4
  8.   0xF0,0x08,0xF0,0x00,0xE0,0x18,0x00,0x00,0x00,0x21,0x1C,0x03,0x1E,0x21,0x1E,0x00,//% 5
  9.   0x00,0xF0,0x08,0x88,0x70,0x00,0x00,0x00,0x1E,0x21,0x23,0x24,0x19,0x27,0x21,0x10,//& 6
  10.   0x10,0x16,0x0E,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,//' 7
  11.   0x00,0x00,0x00,0xE0,0x18,0x04,0x02,0x00,0x00,0x00,0x00,0x07,0x18,0x20,0x40,0x00,//( 8
  12.   0x00,0x02,0x04,0x18,0xE0,0x00,0x00,0x00,0x00,0x40,0x20,0x18,0x07,0x00,0x00,0x00,//) 9
  13.   0x40,0x40,0x80,0xF0,0x80,0x40,0x40,0x00,0x02,0x02,0x01,0x0F,0x01,0x02,0x02,0x00,//* 10
  14.   0x00,0x00,0x00,0xF0,0x00,0x00,0x00,0x00,0x01,0x01,0x01,0x1F,0x01,0x01,0x01,0x00,//+ 11
  15.   0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x80,0xB0,0x70,0x00,0x00,0x00,0x00,0x00,//, 12
  16.   0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x01,0x01,0x01,0x01,0x01,0x01,0x01,//- 13
  17.   0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x30,0x30,0x00,0x00,0x00,0x00,0x00,//. 14
  18.   0x00,0x00,0x00,0x00,0x80,0x60,0x18,0x04,0x00,0x60,0x18,0x06,0x01,0x00,0x00,0x00,/// 15
  19.   0x00,0xE0,0x10,0x08,0x08,0x10,0xE0,0x00,0x00,0x0F,0x10,0x20,0x20,0x10,0x0F,0x00,//0 16
  20.   0x00,0x10,0x10,0xF8,0x00,0x00,0x00,0x00,0x00,0x20,0x20,0x3F,0x20,0x20,0x00,0x00,//1 17
  21.   0x00,0x70,0x08,0x08,0x08,0x88,0x70,0x00,0x00,0x30,0x28,0x24,0x22,0x21,0x30,0x00,//2 18
  22.   0x00,0x30,0x08,0x88,0x88,0x48,0x30,0x00,0x00,0x18,0x20,0x20,0x20,0x11,0x0E,0x00,//3 19
  23.   0x00,0x00,0xC0,0x20,0x10,0xF8,0x00,0x00,0x00,0x07,0x04,0x24,0x24,0x3F,0x24,0x00,//4 20
  24.   0x00,0xF8,0x08,0x88,0x88,0x08,0x08,0x00,0x00,0x19,0x21,0x20,0x20,0x11,0x0E,0x00,//5 21
  25.   0x00,0xE0,0x10,0x88,0x88,0x18,0x00,0x00,0x00,0x0F,0x11,0x20,0x20,0x11,0x0E,0x00,//6 22
  26.   0x00,0x38,0x08,0x08,0xC8,0x38,0x08,0x00,0x00,0x00,0x00,0x3F,0x00,0x00,0x00,0x00,//7 23
  27.   0x00,0x70,0x88,0x08,0x08,0x88,0x70,0x00,0x00,0x1C,0x22,0x21,0x21,0x22,0x1C,0x00,//8 24
  28.   0x00,0xE0,0x10,0x08,0x08,0x10,0xE0,0x00,0x00,0x00,0x31,0x22,0x22,0x11,0x0F,0x00,//9 25
  29.   0x00,0x00,0x00,0xC0,0xC0,0x00,0x00,0x00,0x00,0x00,0x00,0x30,0x30,0x00,0x00,0x00,//: 26
  30.   0x00,0x00,0x00,0x80,0x00,0x00,0x00,0x00,0x00,0x00,0x80,0x60,0x00,0x00,0x00,0x00,//; 27
  31.   0x00,0x00,0x80,0x40,0x20,0x10,0x08,0x00,0x00,0x01,0x02,0x04,0x08,0x10,0x20,0x00,//< 28
  32.   0x40,0x40,0x40,0x40,0x40,0x40,0x40,0x00,0x04,0x04,0x04,0x04,0x04,0x04,0x04,0x00,//= 29
  33.   0x00,0x08,0x10,0x20,0x40,0x80,0x00,0x00,0x00,0x20,0x10,0x08,0x04,0x02,0x01,0x00,//> 30
  34.   0x00,0x70,0x48,0x08,0x08,0x08,0xF0,0x00,0x00,0x00,0x00,0x30,0x36,0x01,0x00,0x00,//? 31
  35.   0xC0,0x30,0xC8,0x28,0xE8,0x10,0xE0,0x00,0x07,0x18,0x27,0x24,0x23,0x14,0x0B,0x00,//@ 32
  36.   0x00,0x00,0xC0,0x38,0xE0,0x00,0x00,0x00,0x20,0x3C,0x23,0x02,0x02,0x27,0x38,0x20,//A 33
  37.   0x08,0xF8,0x88,0x88,0x88,0x70,0x00,0x00,0x20,0x3F,0x20,0x20,0x20,0x11,0x0E,0x00,//B 34
  38.   0xC0,0x30,0x08,0x08,0x08,0x08,0x38,0x00,0x07,0x18,0x20,0x20,0x20,0x10,0x08,0x00,//C 35
  39.   0x08,0xF8,0x08,0x08,0x08,0x10,0xE0,0x00,0x20,0x3F,0x20,0x20,0x20,0x10,0x0F,0x00,//D 36
  40.   0x08,0xF8,0x88,0x88,0xE8,0x08,0x10,0x00,0x20,0x3F,0x20,0x20,0x23,0x20,0x18,0x00,//E 37
  41.   0x08,0xF8,0x88,0x88,0xE8,0x08,0x10,0x00,0x20,0x3F,0x20,0x00,0x03,0x00,0x00,0x00,//F 38
  42.   0xC0,0x30,0x08,0x08,0x08,0x38,0x00,0x00,0x07,0x18,0x20,0x20,0x22,0x1E,0x02,0x00,//G 39
  43.   0x08,0xF8,0x08,0x00,0x00,0x08,0xF8,0x08,0x20,0x3F,0x21,0x01,0x01,0x21,0x3F,0x20,//H 40
  44.   0x00,0x08,0x08,0xF8,0x08,0x08,0x00,0x00,0x00,0x20,0x20,0x3F,0x20,0x20,0x00,0x00,//I 41
  45.   0x00,0x00,0x08,0x08,0xF8,0x08,0x08,0x00,0xC0,0x80,0x80,0x80,0x7F,0x00,0x00,0x00,//J 42
  46.   0x08,0xF8,0x88,0xC0,0x28,0x18,0x08,0x00,0x20,0x3F,0x20,0x01,0x26,0x38,0x20,0x00,//K 43
  47.   0x08,0xF8,0x08,0x00,0x00,0x00,0x00,0x00,0x20,0x3F,0x20,0x20,0x20,0x20,0x30,0x00,//L 44
  48.   0x08,0xF8,0xF8,0x00,0xF8,0xF8,0x08,0x00,0x20,0x3F,0x00,0x3F,0x00,0x3F,0x20,0x00,//M 45
  49.   0x08,0xF8,0x30,0xC0,0x00,0x08,0xF8,0x08,0x20,0x3F,0x20,0x00,0x07,0x18,0x3F,0x00,//N 46
  50.   0xE0,0x10,0x08,0x08,0x08,0x10,0xE0,0x00,0x0F,0x10,0x20,0x20,0x20,0x10,0x0F,0x00,//O 47
  51.   0x08,0xF8,0x08,0x08,0x08,0x08,0xF0,0x00,0x20,0x3F,0x21,0x01,0x01,0x01,0x00,0x00,//P 48
  52.   0xE0,0x10,0x08,0x08,0x08,0x10,0xE0,0x00,0x0F,0x18,0x24,0x24,0x38,0x50,0x4F,0x00,//Q 49
  53.   0x08,0xF8,0x88,0x88,0x88,0x88,0x70,0x00,0x20,0x3F,0x20,0x00,0x03,0x0C,0x30,0x20,//R 50
  54.   0x00,0x70,0x88,0x08,0x08,0x08,0x38,0x00,0x00,0x38,0x20,0x21,0x21,0x22,0x1C,0x00,//S 51
  55.   0x18,0x08,0x08,0xF8,0x08,0x08,0x18,0x00,0x00,0x00,0x20,0x3F,0x20,0x00,0x00,0x00,//T 52
  56.   0x08,0xF8,0x08,0x00,0x00,0x08,0xF8,0x08,0x00,0x1F,0x20,0x20,0x20,0x20,0x1F,0x00,//U 53
  57.   0x08,0x78,0x88,0x00,0x00,0xC8,0x38,0x08,0x00,0x00,0x07,0x38,0x0E,0x01,0x00,0x00,//V 54
  58.   0xF8,0x08,0x00,0xF8,0x00,0x08,0xF8,0x00,0x03,0x3C,0x07,0x00,0x07,0x3C,0x03,0x00,//W 55
  59.   0x08,0x18,0x68,0x80,0x80,0x68,0x18,0x08,0x20,0x30,0x2C,0x03,0x03,0x2C,0x30,0x20,//X 56
  60.   0x08,0x38,0xC8,0x00,0xC8,0x38,0x08,0x00,0x00,0x00,0x20,0x3F,0x20,0x00,0x00,0x00,//Y 57
  61.   0x10,0x08,0x08,0x08,0xC8,0x38,0x08,0x00,0x20,0x38,0x26,0x21,0x20,0x20,0x18,0x00,//Z 58
  62.   0x00,0x00,0x00,0xFE,0x02,0x02,0x02,0x00,0x00,0x00,0x00,0x7F,0x40,0x40,0x40,0x00,//[ 59
  63.   0x00,0x0C,0x30,0xC0,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x01,0x06,0x38,0xC0,0x00,//\ 60
  64.   0x00,0x02,0x02,0x02,0xFE,0x00,0x00,0x00,0x00,0x40,0x40,0x40,0x7F,0x00,0x00,0x00,//] 61
  65.   0x00,0x00,0x04,0x02,0x02,0x02,0x04,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,//^ 62
  66.   0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,//_ 63
  67.   0x00,0x02,0x02,0x04,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,//` 64
  68.   0x00,0x00,0x80,0x80,0x80,0x80,0x00,0x00,0x00,0x19,0x24,0x22,0x22,0x22,0x3F,0x20,//a 65
  69.   0x08,0xF8,0x00,0x80,0x80,0x00,0x00,0x00,0x00,0x3F,0x11,0x20,0x20,0x11,0x0E,0x00,//b 66
  70.   0x00,0x00,0x00,0x80,0x80,0x80,0x00,0x00,0x00,0x0E,0x11,0x20,0x20,0x20,0x11,0x00,//c 67
  71.   0x00,0x00,0x00,0x80,0x80,0x88,0xF8,0x00,0x00,0x0E,0x11,0x20,0x20,0x10,0x3F,0x20,//d 68
  72.   0x00,0x00,0x80,0x80,0x80,0x80,0x00,0x00,0x00,0x1F,0x22,0x22,0x22,0x22,0x13,0x00,//e 69
  73.   0x00,0x80,0x80,0xF0,0x88,0x88,0x88,0x18,0x00,0x20,0x20,0x3F,0x20,0x20,0x00,0x00,//f 70
  74.   0x00,0x00,0x80,0x80,0x80,0x80,0x80,0x00,0x00,0x6B,0x94,0x94,0x94,0x93,0x60,0x00,//g 71
  75.   0x08,0xF8,0x00,0x80,0x80,0x80,0x00,0x00,0x20,0x3F,0x21,0x00,0x00,0x20,0x3F,0x20,//h 72
  76.   0x00,0x80,0x98,0x98,0x00,0x00,0x00,0x00,0x00,0x20,0x20,0x3F,0x20,0x20,0x00,0x00,//i 73
  77.   0x00,0x00,0x00,0x80,0x98,0x98,0x00,0x00,0x00,0xC0,0x80,0x80,0x80,0x7F,0x00,0x00,//j 74
  78.   0x08,0xF8,0x00,0x00,0x80,0x80,0x80,0x00,0x20,0x3F,0x24,0x02,0x2D,0x30,0x20,0x00,//k 75
  79.   0x00,0x08,0x08,0xF8,0x00,0x00,0x00,0x00,0x00,0x20,0x20,0x3F,0x20,0x20,0x00,0x00,//l 76
  80.   0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x00,0x20,0x3F,0x20,0x00,0x3F,0x20,0x00,0x3F,//m 77
  81.   0x80,0x80,0x00,0x80,0x80,0x80,0x00,0x00,0x20,0x3F,0x21,0x00,0x00,0x20,0x3F,0x20,//n 78
  82.   0x00,0x00,0x80,0x80,0x80,0x80,0x00,0x00,0x00,0x1F,0x20,0x20,0x20,0x20,0x1F,0x00,//o 79
  83.   0x80,0x80,0x00,0x80,0x80,0x00,0x00,0x00,0x80,0xFF,0xA1,0x20,0x20,0x11,0x0E,0x00,//p 80
  84.   0x00,0x00,0x00,0x80,0x80,0x80,0x80,0x00,0x00,0x0E,0x11,0x20,0x20,0xA0,0xFF,0x80,//q 81
  85.   0x80,0x80,0x80,0x00,0x80,0x80,0x80,0x00,0x20,0x20,0x3F,0x21,0x20,0x00,0x01,0x00,//r 82
  86.   0x00,0x00,0x80,0x80,0x80,0x80,0x80,0x00,0x00,0x33,0x24,0x24,0x24,0x24,0x19,0x00,//s 83
  87.   0x00,0x80,0x80,0xE0,0x80,0x80,0x00,0x00,0x00,0x00,0x00,0x1F,0x20,0x20,0x00,0x00,//t 84
  88.   0x80,0x80,0x00,0x00,0x00,0x80,0x80,0x00,0x00,0x1F,0x20,0x20,0x20,0x10,0x3F,0x20,//u 85
  89.   0x80,0x80,0x80,0x00,0x00,0x80,0x80,0x80,0x00,0x01,0x0E,0x30,0x08,0x06,0x01,0x00,//v 86
  90.   0x80,0x80,0x00,0x80,0x00,0x80,0x80,0x80,0x0F,0x30,0x0C,0x03,0x0C,0x30,0x0F,0x00,//w 87
  91.   0x00,0x80,0x80,0x00,0x80,0x80,0x80,0x00,0x00,0x20,0x31,0x2E,0x0E,0x31,0x20,0x00,//x 88
  92.   0x80,0x80,0x80,0x00,0x00,0x80,0x80,0x80,0x80,0x81,0x8E,0x70,0x18,0x06,0x01,0x00,//y 89
  93.   0x00,0x80,0x80,0x80,0x80,0x80,0x80,0x00,0x00,0x21,0x30,0x2C,0x22,0x21,0x30,0x00,//z 90
  94.   0x00,0x00,0x00,0x00,0x80,0x7C,0x02,0x02,0x00,0x00,0x00,0x00,0x00,0x3F,0x40,0x40,//{ 91
  95.   0x00,0x00,0x00,0x00,0xFF,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xFF,0x00,0x00,0x00,//| 92
  96.   0x00,0x02,0x02,0x7C,0x80,0x00,0x00,0x00,0x00,0x40,0x40,0x3F,0x00,0x00,0x00,0x00,//} 93
  97.   0x00,0x06,0x01,0x01,0x02,0x02,0x04,0x04,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,//~ 94
  98. };

main.c文件

  1. #include "reg52.h"
  2. #include "hc04.h"
  3. #include "delay.h"
  4. #include "sg90.h"
  5. #include "Oled.h"
  6. #include "motor.h"
  7.  
  8. #define MIDDLE 0
  9. #define LEFT 1
  10. #define RIGHT 2
  11.  
  12. #define BZ 1
  13. #define XJ 2
  14. #define GS 3
  15. #define ST 4
  16.  
  17. sbit A25 = P1^5;
  18. sbit A26 = P1^6;
  19. sbit A27 = P1^7;
  20.  
  21. sbit leftSensorX = P2^7;
  22. sbit rightSensorX = P2^6;
  23.  
  24. sbit leftSensorG = P2^5;
  25. sbit rightSensorG = P2^4;
  26.  
  27. char dir;
  28.      
  29. double disMiddle;
  30. double disLeft;
  31. double disRight;
  32.  
  33. void xunjiMode()
  34. {
  35.         if(leftSensorX == 0 && rightSensorX == 0){
  36.             goForward();
  37.         }
  38.         if(leftSensorX == 1 && rightSensorX == 0){
  39.             goLeft();
  40.         }
  41.          
  42.         if(leftSensorX == 0 && rightSensorX == 1){
  43.             goRight(); 
  44.         }
  45.          
  46.         if(leftSensorX == 1 && rightSensorX == 1){
  47.             //停
  48.             stop();
  49.         }
  50. }
  51.  
  52. void gensuiMode()
  53. {
  54.         if(leftSensorG == 0 && rightSensorG == 0){
  55.             goForward();
  56.         }
  57.         if(leftSensorG == 1 && rightSensorG == 0){
  58.             goRight();
  59.         }
  60.          
  61.         if(leftSensorG == 0 && rightSensorG == 1){
  62.              
  63.             goLeft();
  64.         }
  65.          
  66.         if(leftSensorG == 1 && rightSensorG == 1){
  67.             //停
  68.             stop();
  69.         }
  70. }
  71.  
  72. void bizhangMode()
  73. {
  74.     if(dir != MIDDLE){
  75.             sgMiddle();
  76.             dir = MIDDLE;
  77.             Delay300ms();
  78.         }
  79.         disMiddle = get_distance();
  80.          
  81.         if(disMiddle > 45){
  82.             //前进
  83.             goForward();
  84.         }else if(disMiddle < 15){
  85.             goBack();
  86.              
  87.         }else
  88.         {
  89.             //停止
  90.             stop();
  91.             //测左边距离
  92.             sgLeft();
  93.             Delay300ms();
  94.             disLeft = get_distance();
  95.              
  96.             sgMiddle();
  97.             Delay300ms();
  98.              
  99.             sgRight();
  100.             dir = RIGHT;
  101.             Delay300ms();
  102.             disRight = get_distance();
  103.              
  104.             if(disLeft < disRight){
  105.                 goRight();
  106.                 Delay150ms();
  107.                 stop();
  108.             }
  109.             if(disRight < disLeft){
  110.                 goLeft();
  111.                 Delay150ms();
  112.                 stop();
  113.             }
  114.         }
  115.  
  116. }
  117.  
  118. void main()
  119. {
  120.  
  121.     int mark = 0;
  122.      
  123.     Time0Init();
  124.     Time1Init();
  125.     //舵机的初始位置
  126.  
  127.     sgMiddle();
  128.     Delay300ms();
  129.     Delay300ms();
  130.     dir = MIDDLE;
  131.      
  132.     Oled_Init();
  133.     Oled_Clear();
  134.     Oled_Show_Str(2,2,"-----Ready----");
  135.      
  136.     while(1){
  137.         //满足寻迹模式的条件
  138.         if(A25 == 0 && A26 == 1 && A27 == 1){
  139.             if(mark != XJ){
  140.                 Oled_Clear();
  141.                 Oled_Show_Str(2,2,"-----XunJi----");
  142.             }
  143.             mark = XJ;
  144.             xunjiMode();
  145.         }
  146.         //满足跟随模式的条件
  147.         if(A25 == 1 && A26 == 0 && A27 == 1){
  148.             if(mark != BZ){
  149.                 Oled_Clear();
  150.                 Oled_Show_Str(2,2,"-----Bizhang----");
  151.             }
  152.             mark = BZ;
  153.             bizhangMode();
  154.         }
  155.         //满足避障模式的条件
  156.         if(A25 == 1 && A26 == 1 && A27 == 0){
  157.             if(mark != GS){
  158.                 Oled_Clear();
  159.                 Oled_Show_Str(2,2,"-----GenSui----");
  160.             }
  161.             mark = GS;
  162.             gensuiMode();
  163.         }
  164. 				if(A25 == 0 && A26 == 0 && A27 == 0){
  165.             if(mark != ST){
  166.                 Oled_Clear();
  167.                 Oled_Show_Str(2,2,"-----Stop-----");
  168.             }
  169.             mark = ST;
  170.             stop();
  171.         }
  172.      
  173.     }
  174. }

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

Copyright © 2003-2013 www.wpsshop.cn 版权所有，并保留所有权利。

  

闽ICP备14008679号