设为首页收藏本站
切换到窄版

鱼C论坛

 找回密码
 立即注册
鱼C论坛»论坛 › 技术交流 › 综合交流区 › 单片机交流 › 超声波避障
返回列表 发新帖
查看: 2710|回复: 13

[已解决]超声波避障

[复制链接]
joe1
发表于 2021-7-8 21:57:42 | 显示全部楼层 |阅读模式
30鱼币
麻烦来一个超声波避障的单片机程序啊，网上找到的运行不了；希望有注释。在下小白一枚。
最佳答案
月排行榜 / 总排行榜
君苏依寂
2021-7-8 21:57:43
#include<reg52.h>
#include<intrins.h>
#define uchar unsigned char
#define uint unsigned int
#define barrierDis 15      //距离障碍物的距离 
uint sum;
float L;
sbit LED = P0^0;
sbit Trig = P1^1;           //超声波模块的TRIG
sbit Echo = P1^2;           //超声波模块的ECHO
sbit motorDriver_1 =P2^1;  //控制第一个电机，从单片机出来后接L298n模块的IN1
sbit motorDriver_2 =P2^2;  //控制第一个电机，从单片机出来后接L298n模块的IN2
sbit motorDriver_3 =P2^3;  //控制第二个电机，从单片机出来后接L298n模块的IN3
sbit motorDriver_4 =P2^4;  //控制第二个电机，从单片机出来后接L298n模块的IN4
sbit servorControl =P1^0;  //舵机的控制引脚
uchar flag=0;
uchar control=5;
uchar servorTime=0;
uchar lFlag=0;//左方向是否有障碍的标志
uchar rFlag=0;//右方向是否有障碍的标志
void delay(uchar time){         //延迟函数
        uchar i;
        for(;time>0;time--){
                for(i=0;i<255;i++);
        }
}
void stop(){         //小车停止
        motorDriver_1=0;
        motorDriver_2=0;
        motorDriver_3=0;
        motorDriver_4=0;
}
void turnLeft(){                //小车向左转
        motorDriver_1=1;
        motorDriver_2=0;
        motorDriver_3=0;
        motorDriver_4=0;
}                                                 //小车向右转
void turnRight(){
        motorDriver_1=0;
        motorDriver_2=0;
        motorDriver_3=1;
        motorDriver_4=0;
}
void turnUp(){                          //小车向前走
        motorDriver_1=1;
        motorDriver_2=0;
        motorDriver_3=1;
        motorDriver_4=0;
}
void turnDown(){                  //小车向后走
        motorDriver_1=0;
        motorDriver_2=1;
        motorDriver_3=0;
        motorDriver_4=1;
}
void openHc(){
   Trig=1;
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   Trig=0;
}
uchar getDistance(){  //利用超声波模块判断有无障碍物
        TH0=0;
        TL0=0;
        openHc();
        while(!Echo);
        TR0=1;
        while(Echo);
        TR0=0;
        sum=TH0*256+TL0;
        L=(sum*1.78)/100;
        if(L<barrierDis&&flag==0){
                LED=0;
                return 0;
        }
        else{
                LED=1;
                flag=0;
                return 1;
        }
}
void main(){
                LED=1;
                EA=1;
                ET0=1;
                ET1=1;
                TMOD=0x11;
                TH1=0xff;
            TL1=0x9c;
                servorTime=0;
                while(1){
                         stop();         
                         control=15;//控制舵机使超声波模块正对前方
                         servorTime=0;
                         TR1=1;
                         delay(200);
                         TR1=0;
                         turnUp();
                         LED=0;
                         delay(200);
                         LED=1;
                         while(getDistance()==1); //向前行驶，直到前方有障碍物
                         do{
                            stop();
                                control=22;           //使舵机向左摆动
                                servorTime=0;
                                TR1=1;
                                 delay(200);
                                TR1=0;
                                rFlag=getDistance();
                                 control=5;                 //使舵机向右摆动
                                servorTime=0;
                                TR1=1;
                                 delay(200);
                                TR1=0;
                                lFlag=getDistance();
                                turnDown();
                                delay(220);
                                delay(220);
                                delay(220);
                        }while(lFlag==0&&rFlag==0);
                         if(rFlag==1&&lFlag==0)        //左侧没有障碍物
                                 turnLeft();
                         else if(rFlag==0&&lFlag==1)//右侧没有障碍物
                                 turnRight();
                         else if(rFlag==1&&lFlag==1)//两侧都没有障碍物，默认向左走
                                 turnLeft();
                         delay(220);
                         delay(220);
                         delay(200);
                }
}
void T1_int(void) interrupt 3{          //产生舵机所需要的脉冲
                 TH1=0xff;
                TL1= 0x9c;
                servorTime++;
                if(servorTime<=control)
                        servorControl=1;
                else
                        servorControl=0;
                if(servorTime>=200)
                        servorTime=0;
}
void T0_int(void) interrupt 1{          //超声波超出测量范围
                flag=1;
}

最佳答案

君苏依寂

查看完整内容

想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

君苏依寂
发表于 2021-7-8 21:57:43 | 显示全部楼层    本楼为最佳答案   
#include<reg52.h>
#include<intrins.h>
#define uchar unsigned char
#define uint unsigned int
#define barrierDis 15      //距离障碍物的距离 
uint sum;
float L;
sbit LED = P0^0;
sbit Trig = P1^1;           //超声波模块的TRIG
sbit Echo = P1^2;           //超声波模块的ECHO
sbit motorDriver_1 =P2^1;  //控制第一个电机，从单片机出来后接L298n模块的IN1
sbit motorDriver_2 =P2^2;  //控制第一个电机，从单片机出来后接L298n模块的IN2
sbit motorDriver_3 =P2^3;  //控制第二个电机，从单片机出来后接L298n模块的IN3
sbit motorDriver_4 =P2^4;  //控制第二个电机，从单片机出来后接L298n模块的IN4
sbit servorControl =P1^0;  //舵机的控制引脚
uchar flag=0;
uchar control=5;
uchar servorTime=0;
uchar lFlag=0;//左方向是否有障碍的标志
uchar rFlag=0;//右方向是否有障碍的标志
void delay(uchar time){         //延迟函数
        uchar i;
        for(;time>0;time--){
                for(i=0;i<255;i++);
        }
}
void stop(){         //小车停止
        motorDriver_1=0;
        motorDriver_2=0;
        motorDriver_3=0;
        motorDriver_4=0;
}
void turnLeft(){                //小车向左转
        motorDriver_1=1;
        motorDriver_2=0;
        motorDriver_3=0;
        motorDriver_4=0;
}                                                 //小车向右转
void turnRight(){
        motorDriver_1=0;
        motorDriver_2=0;
        motorDriver_3=1;
        motorDriver_4=0;
}
void turnUp(){                          //小车向前走
        motorDriver_1=1;
        motorDriver_2=0;
        motorDriver_3=1;
        motorDriver_4=0;
}
void turnDown(){                  //小车向后走
        motorDriver_1=0;
        motorDriver_2=1;
        motorDriver_3=0;
        motorDriver_4=1;
}
void openHc(){
   Trig=1;
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   Trig=0;
}
uchar getDistance(){  //利用超声波模块判断有无障碍物
        TH0=0;
        TL0=0;
        openHc();
        while(!Echo);
        TR0=1;
        while(Echo);
        TR0=0;
        sum=TH0*256+TL0;
        L=(sum*1.78)/100;
        if(L<barrierDis&&flag==0){
                LED=0;
                return 0;
        }
        else{
                LED=1;
                flag=0;
                return 1;
        }
}
void main(){
                LED=1;
                EA=1;
                ET0=1;
                ET1=1;
                TMOD=0x11;
                TH1=0xff;
            TL1=0x9c;
                servorTime=0;
                while(1){
                         stop();         
                         control=15;//控制舵机使超声波模块正对前方
                         servorTime=0;
                         TR1=1;
                         delay(200);
                         TR1=0;
                         turnUp();
                         LED=0;
                         delay(200);
                         LED=1;
                         while(getDistance()==1); //向前行驶，直到前方有障碍物
                         do{
                            stop();
                                control=22;           //使舵机向左摆动
                                servorTime=0;
                                TR1=1;
                                 delay(200);
                                TR1=0;
                                rFlag=getDistance();
                                 control=5;                 //使舵机向右摆动
                                servorTime=0;
                                TR1=1;
                                 delay(200);
                                TR1=0;
                                lFlag=getDistance();
                                turnDown();
                                delay(220);
                                delay(220);
                                delay(220);
                        }while(lFlag==0&&rFlag==0);
                         if(rFlag==1&&lFlag==0)        //左侧没有障碍物
                                 turnLeft();
                         else if(rFlag==0&&lFlag==1)//右侧没有障碍物
                                 turnRight();
                         else if(rFlag==1&&lFlag==1)//两侧都没有障碍物，默认向左走
                                 turnLeft();
                         delay(220);
                         delay(220);
                         delay(200);
                }
}
void T1_int(void) interrupt 3{          //产生舵机所需要的脉冲
                 TH1=0xff;
                TL1= 0x9c;
                servorTime++;
                if(servorTime<=control)
                        servorControl=1;
                else
                        servorControl=0;
                if(servorTime>=200)
                        servorTime=0;
}
void T0_int(void) interrupt 1{          //超声波超出测量范围
                flag=1;
}
想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

人造人
发表于 2021-7-8 22:21:05 | 显示全部楼层
单片机中的程序和硬件是一一对应的
想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

joe1
 楼主| 发表于 2021-7-9 08:01:42 | 显示全部楼层
人造人 发表于 2021-7-8 22:21
单片机中的程序和硬件是一一对应的

老师让我找网上的程序学习；我只想找一个可以运行的.
想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

joe1
 楼主| 发表于 2021-7-9 08:03:11 | 显示全部楼层
#include<reg52.h>
#define uchar unsigned char
#define uint unsigned int
sbit left_forward=P1^0;        sbit left_backward=P1^1;
sbit right_forward=P1^2;        sbit right_backward=P1^3;
sbit TRIG=P2^0;        sbit ECHO=P2^1;
uint distance,count=0,flag=0;
void delay_ms(uint k);        void lint(void);//初始化
void right(uint ms);                void left(uint ms);
void forward(void);                void stop(void);
void emit(void);
int main(void)
{
        lint();
        stop();
        while(1)
        {
                emit();
                if(distance<30)
                {
                        right(500);
                        stop();
                        count++;
                }
                else
                {
                        forward();
                }
                if(count==2)
                {
                        count=0;left(1500);
                        stop();
                }
        }
}
void emit(void)//超声波
{
        TRIG=0;
        TRIG=1;
        delay_ms(1);
        TRIG=0;
        while(!ECHO);
        TR0=1;
        while(ECHO);
        TR0=0;
        if(flag)
        {
                flag=0;
                distance=300;
        }
        else
        {
                distance=(TH0<8)|TL0;
                distance=distance*1.7/100;
        }
        TH0=0;
        TL0=0;
}
void interrupt_timer0(void)interrupt 1
{
        TH0=0;
        TL0=0;
        flag=1;
}
void delay_ms(uint k)
{
        uint j,i;
        for(i=0;i<k;i++)
                for(j=0;j<125;j++);
}
void lint(void)//计时器
{
        TMOD=0x01;
        TH0=0;
        TL0=0;
        ET0=1;EA=1;TR0=0;
}
void right(uint ms)
{
        left_forward=0;right_forward=1;left_backward=1;right_backward=1;delay_ms(ms);
}
void left(uint ms)
{
        left_forward=1;right_forward=0;left_backward=1;right_backward=1;delay_ms(ms);
}

void forward(void)
{
        left_forward=0;right_forward=0;left_backward=0;right_backward=0;
}
void stop(void)
{
        left_forward=1;right_forward=1;left_backward=1;right_backward=1;
}

}
想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

joe1
 楼主| 发表于 2021-7-9 08:03:43 | 显示全部楼层
joe1 发表于 2021-7-9 08:03
#include
#define uchar unsigned char
#define uint unsigned int

这是我找得代码，运行不出来
想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

joe1
 楼主| 发表于 2021-7-9 08:04:17 | 显示全部楼层
joe1 发表于 2021-7-9 08:01
老师让我找网上的程序学习；我只想找一个可以运行的.

#include<reg52.h>
#define uchar unsigned char
#define uint unsigned int
sbit left_forward=P1^0;        sbit left_backward=P1^1;
sbit right_forward=P1^2;        sbit right_backward=P1^3;
sbit TRIG=P2^0;        sbit ECHO=P2^1;
uint distance,count=0,flag=0;
void delay_ms(uint k);        void lint(void);//初始化
void right(uint ms);                void left(uint ms);
void forward(void);                void stop(void);
void emit(void);
int main(void)
{
        lint();
        stop();
        while(1)
        {
                emit();
                if(distance<30)
                {
                        right(500);
                        stop();
                        count++;
                }
                else
                {
                        forward();
                }
                if(count==2)
                {
                        count=0;left(1500);
                        stop();
                }
        }
}
void emit(void)//超声波
{
        TRIG=0;
        TRIG=1;
        delay_ms(1);
        TRIG=0;
        while(!ECHO);
        TR0=1;
        while(ECHO);
        TR0=0;
        if(flag)
        {
                flag=0;
                distance=300;
        }
        else
        {
                distance=(TH0<8)|TL0;
                distance=distance*1.7/100;
        }
        TH0=0;
        TL0=0;
}
void interrupt_timer0(void)interrupt 1
{
        TH0=0;
        TL0=0;
        flag=1;
}
void delay_ms(uint k)
{
        uint j,i;
        for(i=0;i<k;i++)
                for(j=0;j<125;j++);
}
void lint(void)//计时器
{
        TMOD=0x01;
        TH0=0;
        TL0=0;
        ET0=1;EA=1;TR0=0;
}
void right(uint ms)
{
        left_forward=0;right_forward=1;left_backward=1;right_backward=1;delay_ms(ms);
}
void left(uint ms)
{
        left_forward=1;right_forward=0;left_backward=1;right_backward=1;delay_ms(ms);
}

void forward(void)
{
        left_forward=0;right_forward=0;left_backward=0;right_backward=0;
}
void stop(void)
{
        left_forward=1;right_forward=1;left_backward=1;right_backward=1;
}

}
想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

人造人
发表于 2021-7-9 21:15:41 | 显示全部楼层
joe1 发表于 2021-7-9 08:01
老师让我找网上的程序学习；我只想找一个可以运行的.

"单片机中的程序和硬件是一一对应的"
"我只想找一个可以运行的."
想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

joe1
 楼主| 发表于 2021-7-11 17:49:21 | 显示全部楼层
人造人 发表于 2021-7-9 21:15
"单片机中的程序和硬件是一一对应的"
"我只想找一个可以运行的."

？
想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

wp231957
发表于 2021-7-11 18:08:08 From FishC Mobile | 显示全部楼层
joe1 发表于 2021-7-11 17:49
？

首先你得有一个硬件，然后再研究和这个硬件相匹配的代码
想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

骚年￥学编程
发表于 2021-7-13 07:49:39 | 显示全部楼层
学编程需要知道的 两个 网站  一个是国外的github 一个国内的 码云    你可以在上面找一下有没有你需要的
想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

joe1
 楼主| 发表于 2021-7-13 19:31:46 | 显示全部楼层
君苏依寂 发表于 2021-7-12 13:00

RAMXIZE(256)
* * * FATAL ERROR L210: I/O ERROR ON INPUT FILE:
        EXCEPTION 0021H:PATH OR FILE NOT FOUND
        FILE: C:\KEIL\C51\LTB\C51FPS.LTB
Target not created

想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

Kayko
发表于 2021-7-14 09:45:35 | 显示全部楼层
想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

王逗比666
发表于 2021-7-14 10:28:14 | 显示全部楼层
单片机的代码和硬件是对应的，根据你硬件的不同引脚和IO的位置和地址也不同，所以操纵地址的代码也是不一样的，除非你找到的代码针对的开发板或者你自己做的板子的原理图IO分布位置一样否则是不能直接拿来用的
想知道小甲鱼最近在做啥？请访问 -> ilovefishc.com
回复

使用道具 举报

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

本版积分规则

小黑屋|手机版|Archiver|鱼C工作室 ( 粤ICP备18085999号-1 | 粤公网安备 44051102000585号)

GMT+8, 2024-12-31 12:40

Powered by Discuz! X3.4

© 2001-2023 Discuz! Team.

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