赞
踩
学完51单片机之后,智能小车是一个很好的练手项目,本篇文章介绍的小车具有3个功能,循迹,摇头避障,跟随这三个功能,使用SU-03T语音模块切换这三个功能。
先把小车组装完成后,我们需要驱动电机,使用L9110s。L9110S是一款直流电机驱动电路,该产品为电池供电的玩具、低压或电池供电的控制应用提供了一种集成直流马达驱动的解决方案。电路内部集成了采用MOS管设计的H桥驱动电路,主要应用于驱动通用直流电机。
motor.c代码
- #include "reg52.h"
-
- sbit RightCon1A = P3^7;
- sbit RightCon1B = P3^3;
-
- sbit LeftCon1A = P3^4;
- sbit LeftCon1B = P3^5;
-
- void goForward()//前进
- {
- LeftCon1A = 0;
- LeftCon1B = 1;
-
- RightCon1A = 0;
- RightCon1B = 1;
- }
-
- void goRight()//右转
- {
- LeftCon1A = 0;
- LeftCon1B = 1;
-
- RightCon1A = 0;
- RightCon1B = 0;
- }
-
-
- void goLeft()//左转
- {
- LeftCon1A = 0;
- LeftCon1B = 0;
-
- RightCon1A = 0;
- RightCon1B = 1;
- }
-
- void goBack()//后退
- {
- LeftCon1A = 1;
- LeftCon1B = 0;
-
- RightCon1A = 1;
- RightCon1B = 0;
- }
-
- void stop()//停止
- {
- LeftCon1A = 0;
- LeftCon1B = 0;
-
- RightCon1A = 0;
- RightCon1B = 0;
- }
-
-
循迹模块使用 TCRT5000传感器的红外发射二极管不断发射红外线 当发射出的红外线没有被反射回来或被反射回来但强度不够大时, 红外接收管一直处于关断状态,此时模块的输出端为高电平,指示二极管一直处于熄灭状态 被检测物体出现在检测范围内时,红外线被反射回来且强度足够大,红外接收管饱和, 此时模块的输出端为低电平,指示二极管被点亮 ,总结就是一句话,没反射回来,D0输出高电平,灭灯。
接线方式 VCC:接电源正极(3-5V) GND:接电源负极 DO:TTL开关信号输出0、1 AO:模拟信号输出(不同距离输出不同的电压,此脚一般可以不接) 6.3.2 循迹小车原理 由于黑色具有较强的吸收能力,当循迹模块发射的红外线照射到黑线时,红外线将会被黑线吸收,导致 循迹模块上光敏三极管处于关闭状态,此时模块上一个LED熄灭。在没有检测到黑线时,模块上两个LED 常亮。循迹模块安装在小车车头两侧 下方小车两个模块都能反射回来红外,输出低电平,灯亮,直走 上方小车左模块遇到黑线,红外被吸收,左模块输出高电平,右模块输出低电平,左转,反之右转。
原理和寻线是一样的,寻线红外观朝下,跟随朝前 6.4.2 跟随小车的原理 左边跟随模块能返回红外,输出低电平,右边不能返回,输出高电平,说明物体在左边,需要左转 右边跟随模块能返回红外,输出低电平,左边不能返回,输出高电平,说明物体在右边,需要右转。
超声波避障我们需要两个原件,舵机sg90,HC-SR04。
红色VCC;灰色GND,黄色PWM信号。
向黄色信号线“灌入”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% 对应函数中占空比为1250
定时器需要定时20ms, 关心的单位0.5ms, 40个的0.5ms,初值0.5m cnt++ 1s = 10ms * 100 20ms = 0.5ms * 40。
sg90.c
- #include "reg52.h"
- #include "delay.h"
-
- sbit sg90_con = P1^1;
-
- int jd;
- int cnt = 0;
-
- void Time0Init()
- {
- //1. 配置定时器0工作模式位16位计时
- TMOD &= 0xF0; //设置定时器模式
- TMOD |= 0x01;
- //2. 给初值,定一个0.5出来
- TL0=0x33;
- TH0=0xFE;
- //3. 开始计时
- TR0 = 1;
- TF0 = 0;
- //4. 打开定时器0中断
- ET0 = 1;
- //5. 打开总中断EA
- EA = 1;
- }
-
- void sgMiddle()
- {
- //中间位置
- jd = 3; //90度 1.5ms高电平
- cnt = 0;
- }
-
- void sgLeft()
- {
- //左边位置
- jd = 5; //135度 1.5ms高电平
- cnt = 0;
- }
-
- void sgRight()
- {
- //右边位置
- jd = 1; //0度
- cnt = 0;
- }
-
-
- void Time0Handler() interrupt 1
- {
- cnt++; //统计爆表的次数. cnt=1的时候,报表了1
- //重新给初值
- TL0=0x33;
- TH0=0xFE;
-
- //控制PWM波
- if(cnt < jd){
- sg90_con = 1;
- }else{
- sg90_con = 0;
- }
-
- if(cnt == 40){//爆表40次,经过了20ms
- cnt = 0; //当100次表示1s,重新让cnt从0开始,计算下一次的1s
- sg90_con = 1;
- }
-
- }
超声波测距模块是用来测量距离的一种产品,通过发送和收超声波,利用时间差和声音传播速度, 计算出模块到前方障碍物的距离。
怎么让它发送波?
给Trig端口至少10us的高电平.
怎么知道它开始发了 Echo信号?
由低电平跳转到高电平,表示开始发送波
怎么知道接收了返回波 Echo?
由高电平跳转回低电平,表示波回来了
怎么算时间 Echo引脚维持高电平的时间!
波发出去的那一下,开始启动定时器 波回来的那一下,我们开始停止定时器,计算出中间经过多少时间
怎么算距离 距离 = 速度 (340m/s)* 时间/2
hc04.c
- #include "reg52.h"
- #include "delay.h"
-
- sbit Trig = P2^3;
- sbit Echo = P2^2;
-
- void Time1Init()
- {
- TMOD &= 0x0F; //设置定时器模式
- TMOD |= 0x10;
- TH1 = 0;
- TL1 = 0;
- //设置定时器0工作模式1,初始值设定0开始数数,不着急启动定时器
- }
-
- void startHC()
- {
- Trig = 0;
- Trig = 1;
- Delay10us();
- Trig = 0;
- }
-
- double get_distance()
- {
- double time;
- //定时器数据清零,以便下一次测距
- TH1 = 0;
- TL1 = 0;
- //1. Trig ,给Trig端口至少10us的高电平
- startHC();
- //2. echo由低电平跳转到高电平,表示开始发送波
- while(Echo == 0);
- //波发出去的那一下,开始启动定时器
- TR1 = 1;
- //3. 由高电平跳转回低电平,表示波回来了
- while(Echo == 1);
- //波回来的那一下,我们开始停止定时器
- TR1 = 0;
- //4. 计算出中间经过多少时间
- time = (TH1 * 256 + TL1)*1.085;//us为单位
- //5. 距离 = 速度 (340m/s)* 时间/2
- return (time * 0.017);
- }
oled用来显示当前模式,比如现在我们处于避障模式,我们就在OLED 屏幕上显示---bizhang--
oled.c
- #include "reg52.h"
- #include "intrins.h"
- #include "Oledfont.h"
-
-
- sbit scl = P1^2;
- sbit sda = P1^3;
-
- void IIC_Start()
- {
- scl = 0;
- sda = 1;
- scl = 1;
- _nop_();
- sda = 0;
- _nop_();
- }
-
- void IIC_Stop()
- {
- scl = 0;
- sda = 0;
- scl = 1;
- _nop_();
- sda = 1;
- _nop_();
- }
-
- char IIC_ACK()
- {
- char flag;
- sda = 1;//就在时钟脉冲9期间释放数据线
- _nop_();
- scl = 1;
- _nop_();
- flag = sda;
- _nop_();
- scl = 0;
- _nop_();
-
- return flag;
- }
-
- void IIC_Send_Byte(char dataSend)
- {
- int i;
-
- for(i = 0;i<8;i++){
- scl = 0;//scl拉低,让sda做好数据准备
- sda = dataSend & 0x80;//1000 0000获得dataSend的最高位,给sda
- _nop_();//发送数据建立时间
- scl = 1;//scl拉高开始发送
- _nop_();//数据发送时间
- scl = 0;//发送完毕拉低
- _nop_();//
- dataSend = dataSend << 1;
- }
- }
-
- void Oled_Write_Cmd(char dataCmd)
- {
- // 1. start()
- IIC_Start();
- //
- // 2. 写入从机地址 b0111 1000 0x78
- IIC_Send_Byte(0x78);
- // 3. ACK
- IIC_ACK();
- // 4. cotrol byte: (0)(0)000000 写入命令 (0)(1)000000写入数据
- IIC_Send_Byte(0x00);
- // 5. ACK
- IIC_ACK();
- //6. 写入指令/数据
- IIC_Send_Byte(dataCmd);
- //7. ACK
- IIC_ACK();
- //8. STOP
- IIC_Stop();
- }
-
- void Oled_Write_Data(char dataData)
- {
- // 1. start()
- IIC_Start();
- //
- // 2. 写入从机地址 b0111 1000 0x78
- IIC_Send_Byte(0x78);
- // 3. ACK
- IIC_ACK();
- // 4. cotrol byte: (0)(0)000000 写入命令 (0)(1)000000写入数据
- IIC_Send_Byte(0x40);
- // 5. ACK
- IIC_ACK();
- ///6. 写入指令/数据
- IIC_Send_Byte(dataData);
- //7. ACK
- IIC_ACK();
- //8. STOP
- IIC_Stop();
- }
-
-
- void Oled_Init(void){
- Oled_Write_Cmd(0xAE);//--display off
- Oled_Write_Cmd(0x00);//---set low column address
- Oled_Write_Cmd(0x10);//---set high column address
- Oled_Write_Cmd(0x40);//--set start line address
- Oled_Write_Cmd(0xB0);//--set page address
- Oled_Write_Cmd(0x81); // contract control
- Oled_Write_Cmd(0xFF);//--128
- Oled_Write_Cmd(0xA1);//set segment remap
- Oled_Write_Cmd(0xA6);//--normal / reverse
- Oled_Write_Cmd(0xA8);//--set multiplex ratio(1 to 64)
- Oled_Write_Cmd(0x3F);//--1/32 duty
- Oled_Write_Cmd(0xC8);//Com scan direction
- Oled_Write_Cmd(0xD3);//-set display offset
- Oled_Write_Cmd(0x00);//
-
- Oled_Write_Cmd(0xD5);//set osc division
- Oled_Write_Cmd(0x80);//
-
- Oled_Write_Cmd(0xD8);//set area color mode off
- Oled_Write_Cmd(0x05);//
-
- Oled_Write_Cmd(0xD9);//Set Pre-Charge Period
- Oled_Write_Cmd(0xF1);//
-
- Oled_Write_Cmd(0xDA);//set com pin configuartion
- Oled_Write_Cmd(0x12);//
-
- Oled_Write_Cmd(0xDB);//set Vcomh
- Oled_Write_Cmd(0x30);//
-
- Oled_Write_Cmd(0x8D);//set charge pump enable
- Oled_Write_Cmd(0x14);//
-
- Oled_Write_Cmd(0xAF);//--turn on oled panel
- }
-
- void Oled_Clear()
- {
- unsigned char i,j; //-128 --- 127
-
- for(i=0;i<8;i++){
- Oled_Write_Cmd(0xB0 + i);//page0--page7
- //每个page从0列
- Oled_Write_Cmd(0x00);
- Oled_Write_Cmd(0x10);
- //0到127列,依次写入0,每写入数据,列地址自动偏移
- for(j = 0;j<128;j++){
- Oled_Write_Data(0);
- }
- }
- }
-
- void Oled_Show_Char(char row,char col,char oledChar){ //row*2-2
- unsigned int i;
- Oled_Write_Cmd(0xb0+(row*2-2)); //page 0
- Oled_Write_Cmd(0x00+(col&0x0f)); //low
- Oled_Write_Cmd(0x10+(col>>4)); //high
- for(i=((oledChar-32)*16);i<((oledChar-32)*16+8);i++){
- Oled_Write_Data(F8X16[i]); //写数据oledTable1
- }
-
- Oled_Write_Cmd(0xb0+(row*2-1)); //page 1
- Oled_Write_Cmd(0x00+(col&0x0f)); //low
- Oled_Write_Cmd(0x10+(col>>4)); //high
- for(i=((oledChar-32)*16+8);i<((oledChar-32)*16+8+8);i++){
- Oled_Write_Data(F8X16[i]); //写数据oledTable1
- }
- }
-
-
- /******************************************************************************/
- // 函数名称:Oled_Show_Char
- // 输入参数:oledChar
- // 输出参数:无
- // 函数功能:OLED显示单个字符
- /******************************************************************************/
- void Oled_Show_Str(char row,char col,char *str){
- while(*str!=0){
- Oled_Show_Char(row,col,*str);
- str++;
- col += 8;
- }
- }
语音模块使用的SU-03T
SU-03T接5根线,VCC,GND接电源即可。另外三根线选择A25,A26,A27。 SU-03T通过厂家给的网站配置后即可使用,通过配置后,开发思路是我们说出“循迹”这两个字之后,电平的情况是:A25 == 0 A26 == 1 A27 == 1,说出跟随两个字之后,电平的情况是A25 == 1 A26 == 0 A27 == 1
说出避障两个字之后,A25 == 1 A26 == 1 A27 == 0。
下面将所有代码整合
delay.c
- #include "intrins.h"
-
- void Delay2000ms() //@11.0592MHz
- {
- unsigned char i, j, k;
-
- i = 15;
- j = 2;
- k = 235;
- do
- {
- do
- {
- while (--k);
- } while (--j);
- } while (--i);
- }
-
-
- void Delay10us() //@11.0592MHz
- {
- unsigned char i;
-
- i = 2;
- while (--i);
- }
-
- void Delay300ms() //@11.0592MHz
- {
- unsigned char i, j, k;
-
- _nop_();
- i = 3;
- j = 26;
- k = 223;
- do
- {
- do
- {
- while (--k);
- } while (--j);
- } while (--i);
- }
-
-
- void Delay150ms() //@11.0592MHz
- {
- unsigned char i, j, k;
-
- i = 2;
- j = 13;
- k = 237;
- do
- {
- do
- {
- while (--k);
- } while (--j);
- } while (--i);
- }
-
- void Delay450ms() //@11.0592MHz
- {
- unsigned char i, j, k;
-
- _nop_();
- i = 4;
- j = 39;
- k = 209;
- do
- {
- do
- {
- while (--k);
- } while (--j);
- } while (--i);
- }
-
main.c
- #include "reg52.h"
- #include "hc04.h"
- #include "delay.h"
- #include "sg90.h"
- #include "Oled.h"
- #include "motor.h"
-
- #define MIDDLE 0
- #define LEFT 1
- #define RIGHT 2
-
- #define BZ 1
- #define XJ 2
- #define GS 3
-
-
- sbit A25 = P1^5;
- sbit A26 = P1^6;
- sbit A27 = P1^7;
-
- sbit leftSensorX = P2^7;
- sbit rightSensorX = P2^6;
-
- sbit leftSensorG = P2^5;
- sbit rightSensorG = P2^4;
-
- char dir;
-
- double disMiddle;
- double disLeft;
- double disRight;
-
- void xunjiMode()
- {
- if(leftSensorX == 0 && rightSensorX == 0){
- goForward();
- }
- if(leftSensorX == 1 && rightSensorX == 0){
- goLeft();
- }
-
- if(leftSensorX == 0 && rightSensorX == 1){
- goRight();
- }
-
- if(leftSensorX == 1 && rightSensorX == 1){
- //停
- stop();
- }
- }
-
- void gensuiMode()
- {
- if(leftSensorG == 0 && rightSensorG == 0){
- goForward();
- }
- if(leftSensorG == 1 && rightSensorG == 0){
- goRight();
- }
-
- if(leftSensorG == 0 && rightSensorG == 1){
-
- goLeft();
- }
-
- if(leftSensorG == 1 && rightSensorG == 1){
- //停
- stop();
- }
- }
-
- void bizhangMode()
- {
- if(dir != MIDDLE){
- sgMiddle();
- dir = MIDDLE;
- Delay300ms();
- }
- disMiddle = get_distance();
-
- if(disMiddle > 35){
- //前进
- goForward();
- }else if(disMiddle < 10){
- goBack();
-
- }else
- {
- //停止
- stop();
- //测左边距离
- sgLeft();
- Delay300ms();
- disLeft = get_distance();
-
- sgMiddle();
- Delay300ms();
-
- sgRight();
- dir = RIGHT;
- Delay300ms();
- disRight = get_distance();
-
- if(disLeft < disRight){
- goRight();
- Delay150ms();
- stop();
- }
- if(disRight < disLeft){
- goLeft();
- Delay150ms();
- stop();
- }
- }
-
- }
-
- void main()
- {
-
- int mark = 0;
-
- Time0Init();
- Time1Init();
- //舵机的初始位置
-
- sgMiddle();
- Delay300ms();
- Delay300ms();
- dir = MIDDLE;
-
- Oled_Init();
- Oled_Clear();
- Oled_Show_Str(2,2,"-----Ready----");
-
- while(1){
- //满足寻迹模式的条件
- if(A25 == 0 && A26 == 1 && A27 == 1){
- if(mark != XJ){
- Oled_Clear();
- Oled_Show_Str(2,2,"-----XunJi----");
- }
- mark = XJ;
- xunjiMode();
- }
- //满足跟随模式的条件
- if(A25 == 1 && A26 == 0 && A27 == 1){
- if(mark != GS){
- Oled_Clear();
- Oled_Show_Str(2,2,"-----GenSui----");
- }
- mark = GS;
- gensuiMode();
- }
- //满足避障模式的条件
- if(A25 == 1 && A26 == 1 && A27 == 0){
- if(mark != BZ){
- Oled_Clear();
- Oled_Show_Str(2,2,"-----BiZhang----");
- }
- mark = BZ;
- bizhangMode();
- }
-
- }
- }
-
-
-
-
-
-
最后,语音切换循迹避障跟随功能并跟随OLED显示小车就完成了。
Copyright © 2003-2013 www.wpsshop.cn 版权所有,并保留所有权利。