三個對管智能循跡小車

ID:84299 · 發表于 2015-11-18 21:17

本次上傳的是，三個對管來檢測黑線，可以實現小車循跡，在十字交叉路口處可以擇道而行，也就是小車在田字形黑線地圖上可以根據自己設定的路線跑，在十字路口處自己選擇前進，左轉還是右轉。

ID:236952 · 發表于 2017-10-14 00:50

這個真的很有用啊

ID:1 · 發表于 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定時
TL0=(65536-1000)%256;
TR0=1;
ET0=1;
EA=1;
}
uchar lukounum()//檢測路口
{
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)//左輪前進調速
{
if(pwm_l_g<=x){ D2=1; }
else {D2=0;}
if(pwm_l_g>=20)
pwm_l_g=0;
}
void pwmleftback(uchar x)//左輪后退調速
{
if(pwm_l_b<=x){ D3=1; }
else {D3=0;}
if(pwm_l_b>=20)
pwm_l_b=0;
}
// 右電機調速
void pwmrightgo(uchar x)//右輪前進調速
{
if(pwm_r_g<=x) {D0=1;}
else {D0=0; }
if(pwm_r_g>=20)
pwm_r_g=0;
}
void pwmrightback(uchar x)//右輪后退調速
{
if(pwm_r_b<=x) {D1=1;}
else {D1=0;}
if(pwm_r_b>=20)
pwm_r_b=0;
}
void run(uchar y)//前進
{
D1=0;D3=0;
pwmleftgo(y);
pwmrightgo(y);
}
// void rec(uchar y) //后退
// {
// D0=0;
// pwmleftback(y);
// D2=0;
// pwmrightback(y);
// }
void left(uchar y) //左轉
{
pwmrightgo(y);
D1=0;
D2=0;
D3=0;
}
void right(uchar y) //右轉
{
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)//路口選擇運作方式
{
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

復制代碼

ID:742403 · 發表于 2020-5-1 17:20

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

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

難頂啊

帳號		自動登錄	找回密碼
密碼			立即注冊

wwwxxx国产_337p日本欧洲亚洲大胆张筱雨_免费在线看成人av_日本黄色不卡视频_国产精品成熟老女人_99视频一区_亚洲精品97久久中文字幕_免费精品视频在线_亚洲色图欧美视频_欧美一区二三区

三個對管智能循跡小車

評分

相關帖子

	沙發無效樓層，該帖已經被刪除