單片機(jī)+超聲波控制舵機(jī)轉(zhuǎn)動(dòng)源程序

ID:595263 · 發(fā)表于 2020-3-12 17:52

單片機(jī)源程序如下:

#include<reg52.h>
#include<stdio.h>
#include<intrins.h>
#define uchar unsigned char
#define uint unsigned int
sbit Trig=P3^4; //控制端
sbit Echo=P3^5; //接收端
sbit led=P1^3;
sbit servorControl =P1^3; //舵機(jī)的控制引腳
uchar flag=0;
uchar control=5;
uchar servorTime=0;
unsigned char T0RH=0;
unsigned char T0RL=0;
void time_init()
{
EA=1;
TMOD=0x11;
TH0 = 0;
TL0 = 0;
}
///////////////////////////////////////
void delay(uchar time){ //延遲函數(shù)
uchar i;
for(;time>0;time--){
for(i=0;i<255;i++);
}
}
//初始化定時(shí)器
void Delay_us(unsigned char t)
{
while(--t);
} //大約延時(shí)t*2+5us 超聲波模塊用
//////////////////////////////////////
void timer0()interrupt 1
{
TH0 = 0;
TL0 = 0;
}
//中斷程序初始化賦值重新計(jì)數(shù) 超聲波模塊用計(jì)算時(shí)間
void main()
{
unsigned int time,distance;
EA=1;
ET0=1;
ET1=1;
TMOD=0x11;
TH1=0xff;
TL1=0x9c;
servorTime=0;
Trig=0;
Echo=0;
time_init();
while(1)
{
Trig=1;
Delay_us(5);
Trig=0;
while(Echo==0);
TR0=1;
while(Echo);
TR0=0;
time=TH0*256+TL0;
distance=(int)(time*0.017); //計(jì)算路程單位為cm
TH0=0;
TL0=0;
if(distance<30) //如果距離小于30cm 蜂鳴器響
{
control=15; //使舵機(jī)向正擺動(dòng)
servorTime=0;
TR1=1;
delay(200);
delay(200);
TR1=0;
}
else
{
control=5; //使舵機(jī)向右擺動(dòng)
servorTime=0;
TR1=1;
delay(200);
delay(200);
TR1=0;
delay(200);
delay(200);
}
}
}
void T1_int(void) interrupt 3{ //產(chǎn)生舵機(jī)所需要的脈沖
TH1=0xff;
TL1= 0x9c;
servorTime++;
if(servorTime<=control)
servorControl=1;
else
servorControl=0;
if(servorTime>=200)
servorTime=0;
}

復(fù)制代碼

所有資料51hei提供下載:

舵機(jī)轉(zhuǎn)向與超聲波.zip (29.16 KB, 下載次數(shù): 14)

ID:1 · 發(fā)表于 2020-3-12 22:18

本帖需要重新編輯補(bǔ)全電路原理圖,源碼,詳細(xì)說(shuō)明與圖片即可獲得100+黑幣(帖子下方有編輯按鈕)

ID:461901 · 發(fā)表于 2020-4-1 15:40

admin 發(fā)表于 2020-3-12 22:18
本帖需要重新編輯補(bǔ)全電路原理圖,源碼,詳細(xì)說(shuō)明與圖片即可獲得100+黑幣(帖子下方有編輯按鈕)

沒(méi)有編輯按鈕啊

帳號(hào)		自動(dòng)登錄	找回密碼
密碼			立即注冊(cè)

久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

單片機(jī)+超聲波控制舵機(jī)轉(zhuǎn)動(dòng)源程序