標(biāo)題:
尋跡車單片機(jī)源程序
[打印本頁(yè)]
作者:
唯戀一人心
時(shí)間:
2017-11-15 20:35
標(biāo)題:
尋跡車單片機(jī)源程序
/****************************************************************************
簡(jiǎn)單尋跡程序:接法
EN1 EN2 PWM輸入端,本程序不輸入PWM,直接使插上跳線帽,使能輸出,這樣就能全速運(yùn)行
無(wú)線搖控模塊與單片機(jī)連接
無(wú)線模塊GND +5取自于單片機(jī)板的5V輸出
P0_7 與無(wú)線模塊D0相連
P0_6 與無(wú)線模塊D1相連
P0_5 與無(wú)線模塊D2相連
P0_4 與無(wú)線模塊D3相連
P1_0 P1_1 接IN1 IN2 當(dāng) P1_0=1,P1_1=0; 時(shí)左上電機(jī)正轉(zhuǎn) 左上電機(jī)接驅(qū)動(dòng)板子輸出端(藍(lán)色端子OUT1 OUT2)
P1_0 P1_1 接IN1 IN2 當(dāng) P1_0=0,P1_1=1; 時(shí)左上電機(jī)反轉(zhuǎn)
P1_0 P1_1 接IN1 IN2 當(dāng) P1_0=0,P1_1=0; 時(shí)左上電機(jī)停轉(zhuǎn)
P1_2 P1_3 接IN3 IN4 當(dāng) P1_2=1,P1_3=0; 時(shí)左下電機(jī)正轉(zhuǎn) 左下電機(jī)接驅(qū)動(dòng)板子輸出端(藍(lán)色端子OUT3 OUT4)
P1_2 P1_3 接IN3 IN4 當(dāng) P1_2=0,P1_3=1; 時(shí)左下電機(jī)反轉(zhuǎn)
P1_2 P1_3 接IN3 IN4 當(dāng) P1_2=0,P1_3=0; 時(shí)左下電機(jī)停轉(zhuǎn)
P1_4 P1_5 接IN5 IN6 當(dāng) P1_4=1,P1_5=0; 時(shí)右上電機(jī)正轉(zhuǎn) 右上電機(jī)接驅(qū)動(dòng)板子輸出端(藍(lán)色端子OUT5 OUT6)
P1_4 P1_5 接IN5 IN6 當(dāng) P1_4=0,P1_5=1; 時(shí)右上電機(jī)反轉(zhuǎn)
P1_4 P1_5 接IN5 IN6 當(dāng) P1_4=0,P1_5=0; 時(shí)右上電機(jī)停轉(zhuǎn)
P1_6 P1_7 接IN7 IN8 當(dāng) P1_6=1,P1_7=0; 時(shí)右下電機(jī)正轉(zhuǎn) 右下電機(jī)接驅(qū)動(dòng)板子輸出端(藍(lán)色端子OUT7 OUT8)
P1_6 P1_7 接IN7 IN8 當(dāng) P1_6=0,P1_7=1; 時(shí)右下電機(jī)反轉(zhuǎn)
P1_6 P1_7 接IN7 IN8 當(dāng) P1_6=0,P1_7=0; 時(shí)右下電機(jī)停轉(zhuǎn)
P3_2接四路尋跡模塊接口第一路輸出信號(hào)即中控板上面標(biāo)記為OUT1
P3_3接四路尋跡模塊接口第二路輸出信號(hào)即中控板上面標(biāo)記為OUT2
P3_4接四路尋跡模塊接口第三路輸出信號(hào)即中控板上面標(biāo)記為OUT3
P3_5接四路尋跡模塊接口第四路輸出信號(hào)即中控板上面標(biāo)記為OUT4
四路尋跡傳感器有信號(hào)(白線)為0 沒(méi)有信號(hào)(黑線)為1
四路尋跡傳感器電源+5V GND 取自于單片機(jī)板靠近液晶調(diào)節(jié)對(duì)比度的電源輸出接口
關(guān)于單片機(jī)電源:本店驅(qū)動(dòng)模塊內(nèi)帶LDO穩(wěn)壓芯片,當(dāng)電池輸入6V時(shí)時(shí)候可以輸出穩(wěn)定的5V
分別在針腳標(biāo)+5 與GND 。這個(gè)輸出電源可以作為單片機(jī)系統(tǒng)的供電電源。
****************************************************************************/
#include<AT89x51.H>
#define Left_1_led P3_4 //P3_2接四路尋跡模塊接口第一路輸出信號(hào)即中控板上面標(biāo)記為OUT1
#define Left_2_led P3_5 //P3_3接四路尋跡模塊接口第二路輸出信號(hào)即中控板上面標(biāo)記為OUT2
#define Right_1_led P3_6 //P3_4接四路尋跡模塊接口第三路輸出信號(hào)即中控板上面標(biāo)記為OUT3
#define Right_2_led P3_7 //P3_5接四路尋跡模塊接口第四路輸出信號(hào)即中控板上面標(biāo)記為OUT4
#define Left_moto_go {P1_0=1,P1_1=0,P1_2=1,P1_3=0;} //左邊兩個(gè)電機(jī)向前走
#define Left_moto_back {P1_0=0,P1_1=1,P1_2=0,P1_3=1;} //左邊兩個(gè)電機(jī)向后轉(zhuǎn)
#define Left_moto_Stop {P1_0=0,P1_1=0,P1_2=0,P1_3=0;} //左邊兩個(gè)電機(jī)停轉(zhuǎn)
#define Right_moto_go {P1_4=1,P1_5=0,P1_6=1,P1_7=0;} //右邊兩個(gè)電機(jī)向前走
#define Right_moto_back {P1_4=0,P1_5=1,P1_6=0,P1_7=1;} //右邊兩個(gè)電機(jī)向前走
#define Right_moto_Stop {P1_4=0,P1_5=0,P1_6=0,P1_7=0;} //右邊兩個(gè)電機(jī)停轉(zhuǎn)
#define left 'C'
#define right 'D'
#define up 'A'
#define down 'B'
#define stop 'F'
char code str[] = "收到指令,向前!\n";
char code str1[] = "收到指令,向后!\n";
char code str2[] = "收到指令,向左!\n";
char code str3[] = "收到指令,向右!\n";
char code str4[] = "收到指令,停止!\n";
bit flag_REC=0;
bit flag =0;
// unsigned char i=0;
unsigned char dat;
// unsigned char buff[5]=0; //接收緩沖字節(jié)
/************************************************************************/
//延時(shí)函數(shù)
void delay(unsigned int k)
{
unsigned int x,y;
for(x=0;x<k;x++)
for(y=0;y<2000;y++);
}
/************************************************************************/
//字符串發(fā)送函數(shù)
void send_str( )
// 傳送字串
{
unsigned char i = 0;
while(str[i] != '\0')
{
SBUF = str[i];
while(!TI); // 等特?cái)?shù)據(jù)傳送
TI = 0; // 清除數(shù)據(jù)傳送標(biāo)志
i++; // 下一個(gè)字符
}
}
void send_str1( )
// 傳送字串
{
unsigned char i = 0;
while(str1[i] != '\0')
{
SBUF = str1[i];
while(!TI); // 等特?cái)?shù)據(jù)傳送
TI = 0; // 清除數(shù)據(jù)傳送標(biāo)志
i++; // 下一個(gè)字符
}
}
void send_str2( )
// 傳送字串
{
unsigned char i = 0;
while(str2[i] != '\0')
{
SBUF = str2[i];
while(!TI); // 等特?cái)?shù)據(jù)傳送
TI = 0; // 清除數(shù)據(jù)傳送標(biāo)志
i++; // 下一個(gè)字符
}
}
void send_str3()
// 傳送字串
{
unsigned char i = 0;
while(str3[i] != '\0')
{
SBUF = str3[i];
while(!TI); // 等特?cái)?shù)據(jù)傳送
TI = 0; // 清除數(shù)據(jù)傳送標(biāo)志
i++; // 下一個(gè)字符
}
}
void send_str4()
// 傳送字串
{
unsigned char i = 0;
while(str4[i] != '\0')
{
SBUF = str4[i];
while(!TI); // 等特?cái)?shù)據(jù)傳送
TI = 0; // 清除數(shù)據(jù)傳送標(biāo)志
i++; // 下一個(gè)字符
}
}
/************************************************************************/
//前速前進(jìn)
void run(void)
{
flag=0;
Left_moto_go ; //左電機(jī)往前走
Right_moto_go ; //右電機(jī)往前走
delay(5000);
}
//前速后退
void backrun(void)
{
flag=0;
Left_moto_back ; //左電機(jī)往前走
Right_moto_back ; //右電機(jī)往前走
delay(5000);
}
//左轉(zhuǎn)
void leftrun(void)
{
flag=0;
Left_moto_back ; //左電機(jī)往前走
Right_moto_go ; //右電機(jī)往前走
delay(5000);
}
//右轉(zhuǎn)
void rightrun(void)
{
flag=0;
Left_moto_go ; //左電機(jī)往前走
Right_moto_back ; //右電機(jī)往前走
delay(5000);
}
//STOP
void stoprun(void)
{
flag=0;
Left_moto_Stop ; //左電機(jī)往前走
Right_moto_Stop ; //右電機(jī)往前走
}
/************************************************************************/
void sint() interrupt 4 //中斷接收3個(gè)字節(jié)
{
if(RI) //是否接收中斷
{
RI=0;
dat=SBUF;
flag=1;
// if(dat=='O'&&(i==0)) //接收數(shù)據(jù)第一幀
// {
// buff[i]=dat;
// flag=1; //開(kāi)始接收數(shù)據(jù)
// }
// else
// if(flag==1)
// {
// i++;
// buff[i]=dat;
// if(i>=2)
// {i=0;flag=0;flag_REC=1 ;} // 停止接收
// }
}
}
/*********************************************************************/
/*--主函數(shù)--*/
void main(void)
{
TMOD=0x20;
TH1=0xFd; //11.0592M晶振,9600波特率
TL1=0xFd;
SCON=0x50;
PCON=0x00;
TR1=1;
ES=1;
EA=1;
while(1) /*無(wú)限循環(huán)*/
{
if(flag==1) //
{
// flag_REC=0;
// if(buff[0]=='O'&&buff[1]=='N') //第一個(gè)字節(jié)為O,第二個(gè)字節(jié)為N,第三個(gè)字節(jié)為控制碼
switch(dat)
{
case 0x01 : // 前進(jìn)
send_str();
run();
break;
case 0x04: // 后退
send_str1();
backrun();
break;
case 0x03: // 左轉(zhuǎn)
send_str2();
leftrun();
break;
case 0x02: // 右轉(zhuǎn)
send_str3();
rightrun();
break;
case 0x05: // 停止
send_str4( );
stoprun();
break;
default : flag=1;
}
}
}
}
復(fù)制代碼
歡迎光臨 (http://www.torrancerestoration.com/bbs/)
Powered by Discuz! X3.1