三個(gè)對(duì)管智能循跡小車

ID:84299 · 發(fā)表于 2015-11-18 21:17

本次上傳的是，三個(gè)對(duì)管來檢測(cè)黑線，可以實(shí)現(xiàn)小車循跡，在十字交叉路口處可以擇道而行，也就是小車在田字形黑線地圖上可以根據(jù)自己設(shè)定的路線跑，在十字路口處自己選擇前進(jìn)，左轉(zhuǎn)還是右轉(zhuǎn)。

ID:236952 · 發(fā)表于 2017-10-14 00:50

這個(gè)真的很有用啊

ID:1 · 發(fā)表于 2017-10-14 01:03

樓主程序的主要部分：

#ifndef _DEF_H__
#define _DEF_H__
#define uchar unsigned char
#define uint unsigned int
uint pwm_r_g=0,pwm_r_b=0,pwm_l_g=0,pwm_l_b=0;
bit flag=0;
sbit R=P2^0;
sbit L=P2^1;
sbit Z=P2^6;
sbit D0=P2^2;
sbit D1=P2^3;
sbit D2=P2^4;
sbit D3=P2^5;
void init()
{
TMOD=0X01;
TH0=(65536-1000)/256; //1Ms定時(shí)
TL0=(65536-1000)%256;
TR0=1;
ET0=1;
EA=1;
}
uchar lukounum()//檢測(cè)路口
{
static uchar n=0;
if((R==1)&&(L==1)){ n++;flag=1;}
if(n==6){ n=0;}
return n;
}
void delayms(uint xms)
{
uint i,j;
for(i=xms;i>0;i--)
for(j=110;j>0;j--);
}
//void stop() //停止
//{
// D0=0;D1=0;D2=0;D3=0;
//}
void pwmleftgo(uchar x)//左輪前進(jìn)調(diào)速
{
if(pwm_l_g<=x){ D2=1; }
else {D2=0;}
if(pwm_l_g>=20)
pwm_l_g=0;
}
void pwmleftback(uchar x)//左輪后退調(diào)速
{
if(pwm_l_b<=x){ D3=1; }
else {D3=0;}
if(pwm_l_b>=20)
pwm_l_b=0;
}
// 右電機(jī)調(diào)速
void pwmrightgo(uchar x)//右輪前進(jìn)調(diào)速
{
if(pwm_r_g<=x) {D0=1;}
else {D0=0; }
if(pwm_r_g>=20)
pwm_r_g=0;
}
void pwmrightback(uchar x)//右輪后退調(diào)速
{
if(pwm_r_b<=x) {D1=1;}
else {D1=0;}
if(pwm_r_b>=20)
pwm_r_b=0;
}
void run(uchar y)//前進(jìn)
{
D1=0;D3=0;
pwmleftgo(y);
pwmrightgo(y);
}
// void rec(uchar y) //后退
// {
// D0=0;
// pwmleftback(y);
// D2=0;
// pwmrightback(y);
// }
void left(uchar y) //左轉(zhuǎn)
{
pwmrightgo(y);
D1=0;
D2=0;
D3=0;
}
void right(uchar y) //右轉(zhuǎn)
{
D0=0;
D1=0;
pwmleftgo(y);
D3=0;
}
void xun()
{
if((L==0)&&(R==1))
{
right(4);
}
if((L==1)&&(R==0))
{
left(4);
}
if((L==0)&&(R==0))
{
run(4);
}
}
void lukouxuanze(uchar k)//路口選擇運(yùn)作方式
{
switch(k)
{
case 0:run(4);break;
case 1:left(4);break;
case 2:right(4);break;
case 3:right(4);break;
case 4:left(4);break;
case 5:run(4);break;
}
}
#endif

復(fù)制代碼

ID:742403 · 發(fā)表于 2020-5-1 17:20

admin 發(fā)表于 2017-10-14 01:03
樓主程序的主要部分：

這個(gè)主要部分，我在zip包里沒找見啊

難頂啊

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

三個(gè)對(duì)管智能循跡小車

評(píng)分

相關(guān)帖子