国产色一区二区三区,日韩中文字幕欧美,亚洲国产成人av

/****************************************************************************
簡單尋跡程序：接法
EN1 EN2 PWM輸入端，本程序不輸入PWM，直接使插上跳線帽，使能輸出，這樣就能全速運行
插入藍牙模塊：
晶振：11。0592M晶振
請注意跳線帽切換
P1_0 P1_1 接IN1 IN2 當 P1_0=1,P1_1=0; 時左上電機正轉左上電機接驅動板子輸出端（藍色端子OUT1 OUT2）
P1_0 P1_1 接IN1 IN2 當 P1_0=0,P1_1=1; 時左上電機反轉
P1_0 P1_1 接IN1 IN2 當 P1_0=0,P1_1=0; 時左上電機停轉
P1_2 P1_3 接IN3 IN4 當 P1_2=1,P1_3=0; 時左下電機正轉左下電機接驅動板子輸出端（藍色端子OUT3 OUT4）
P1_2 P1_3 接IN3 IN4 當 P1_2=0,P1_3=1; 時左下電機反轉
P1_2 P1_3 接IN3 IN4 當 P1_2=0,P1_3=0; 時左下電機停轉
P1_4 P1_5 接IN5 IN6 當 P1_4=1,P1_5=0; 時右上電機正轉右上電機接驅動板子輸出端（藍色端子OUT5 OUT6）
P1_4 P1_5 接IN5 IN6 當 P1_4=0,P1_5=1; 時右上電機反轉
P1_4 P1_5 接IN5 IN6 當 P1_4=0,P1_5=0; 時右上電機停轉
P1_6 P1_7 接IN7 IN8 當 P1_6=1,P1_7=0; 時右下電機正轉右下電機接驅動板子輸出端（藍色端子OUT7 OUT8）
P1_6 P1_7 接IN7 IN8 當 P1_6=0,P1_7=1; 時右下電機反轉
P1_6 P1_7 接IN7 IN8 當 P1_6=0,P1_7=0; 時右下電機停轉
P3_2接四路尋跡模塊接口第一路輸出信號即中控板上面標記為OUT1
P3_3接四路尋跡模塊接口第二路輸出信號即中控板上面標記為OUT2
P3_4接四路尋跡模塊接口第三路輸出信號即中控板上面標記為OUT3
P3_5接四路尋跡模塊接口第四路輸出信號即中控板上面標記為OUT4
四路尋跡傳感器有信號(白線）為0 沒有信號（黑線）為1
四路尋跡傳感器電源+5V GND 取自于單片機板靠近液晶調節對比度的電源輸出接口
關于單片機電源：本店驅動模塊內帶LDO穩壓芯片，當電池輸入6V時時候可以輸出穩定的5V
分別在針腳標+5 與GND 。這個輸出電源可以作為單片機系統的供電電源。
****************************************************************************/
#include<AT89x52.H>
#include <intrins.h>
#define uchar unsigned char
#define uint unsigned int
uchar step_g[8]={0x88, 0x99, 0x11, 0x33, 0x22, 0x66, 0x44, 0xcc}; //步進電機前進單步脈沖
uchar step_b[8]={0xcc, 0x44, 0x66, 0x22, 0x33, 0x11, 0x99, 0x88}; //步進電機后退單步脈沖
uchar step_l[8]={0xc8, 0x49, 0x61, 0x23, 0x32, 0x16, 0x94, 0x8c};//步進電機左轉單步脈沖
uchar step_r[8]={0x8c, 0x94, 0x16, 0x32, 0x23, 0x61, 0x49, 0xc8};
//步進電機右轉單步脈沖
uchar step_stop[8]={0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
#define ECHO P2_4 //超聲波接口定義
#define TRIG P2_5 //超聲波接口定義
#define Sevro_moto_pwm P2_7 //接舵機信號端輸入PWM信號調節速度
#define Left_1_led P3_4 //P3_2接四路尋跡模塊接口第一路輸出信號即中控板上面標記為OUT1
#define Left_2_led P3_5 //P3_3接四路尋跡模塊接口第二路輸出信號即中控板上面標記為OUT2
#define Right_1_led P3_6 //P3_4接四路尋跡模塊接口第三路輸出信號即中控板上面標記為OUT3
#define Right_2_led P3_7
#define left 'C'
#define right 'D'
#define up 'A'
#define down 'B'
#define stop 'F'
#define Car '1' //手機軟件1號鍵
#define Car1 '2' //手機軟件1號鍵
char code str[] = "收到指令，向前!\n";
char code str1[] = "收到指令，向后!\n";
char code str2[] = "收到指令，向左!\n";
char code str3[] = "收到指令，向右!\n";
char code str4[] = "收到指令，停止!\n";
unsigned char const discode[] ={ 0xC0,0xF9,0xA4,0xB0,0x99,0x92,0x82,0xF8,0x80,0x90,0xBF,0xff/*-*/};
unsigned char const positon[3]={ 0xfe,0xfd,0xfb};
unsigned char disbuff[4] ={ 0,0,0,0,};
unsigned char posit=0;
unsigned char pwm_val_left = 0;//變量定義
unsigned char push_val_left =13;//舵機歸中，產生約，1.5MS 信號
unsigned int time=0; //時間變量
unsigned int timer1=0; //時間變量
unsigned int timer=0; //延時基準變量
unsigned long S=0; //計算出超聲波距離值
unsigned long S1=0;
unsigned long S2=0;
unsigned long S3=0;
unsigned long S4=0;
bit flag_REC=0; //串行接收標去位
bit flag =0;
bit flag_xj =0;
bit flag_bj =0;
unsigned char i=0;
unsigned char dat=0;
unsigned char buff[5]=0; //接收緩沖字節
/************************************************************************/
//延時函數
void delay(unsigned int k)
{
unsigned int x,y;
for(x=0;x<k;x++)
for(y=0;y<2000;y++);
}
/************************************************************************/
//前速前進
void run(void)
{
uchar step_g[8]={0x88, 0x99, 0x11, 0x33, 0x22, 0x66, 0x44, 0xcc};
}
//前速后退
void backrun(void)
{
uchar step_b[8]={0xcc, 0x44, 0x66, 0x22, 0x33, 0x11, 0x99, 0x88};
}
//左轉
void leftrun(void)
{
uchar step_l[8]={0xc8, 0x49, 0x61, 0x23, 0x32, 0x16, 0x94, 0x8c};
}
//右轉
void rightrun(void)
{
uchar step_r[8]={0x8c, 0x94, 0x16, 0x32, 0x23, 0x61, 0x49, 0xc8};
}
//STOP
void stoprun(void)
{
uchar step_stop[8]={0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
}
/************************************************************************/
void StartModule() //啟動測距信號
{
TRIG=1;
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
TRIG=0;
}
/***************************************************/
void Conut(void) //計算距離
{
while(!ECHO); //當RX為零時等待
TR0=1; //開啟計數
while(ECHO); //當RX為1計數并等待
TR0=0; //關閉計數
time=TH0*256+TL0; //讀取脈寬長度
TH0=0;
TL0=0;
S=(time*1.7)/100; //算出來是CM
disbuff[0]=S%1000/100; //更新顯示
disbuff[1]=S%1000%100/10;
disbuff[2]=S%1000%10 %10;
}
/************************************************************************/
//字符串發送函數
void send_str( )
// 傳送字串
{
unsigned char i = 0;
while(str[i] != '\0')
{
SBUF = str[i];
while(!TI); // 等特數據傳送
TI = 0; // 清除數據傳送標志
i++; // 下一個字符
}
}
void send_str1( )
// 傳送字串
{
unsigned char i = 0;
while(str1[i] != '\0')
{
SBUF = str1[i];
while(!TI); // 等特數據傳送
TI = 0; // 清除數據傳送標志
i++; // 下一個字符
}
}
void send_str2( )
// 傳送字串
{
unsigned char i = 0;
while(str2[i] != '\0')
{
SBUF = str2[i];
while(!TI); // 等特數據傳送
TI = 0; // 清除數據傳送標志
i++; // 下一個字符
}
}
void send_str3()
// 傳送字串
{
unsigned char i = 0;
while(str3[i] != '\0')
{
SBUF = str3[i];
while(!TI); // 等特數據傳送
TI = 0; // 清除數據傳送標志
i++; // 下一個字符
}
}
void send_str4()
// 傳送字串
{
unsigned char i = 0;
while(str4[i] != '\0')
{
SBUF = str4[i];
while(!TI); // 等特數據傳送
TI = 0; // 清除數據傳送標志
i++; // 下一個字符
}
}
/************************************************************************/
void Display(void) //掃描數碼管
{
if(posit==0)
{P0=(discode[disbuff[posit]])&0x7f;}//產生點
else
{P0=discode[disbuff[posit]];}
if(posit==0)
{ P2_1=0;P2_2=1;P2_3=1;}
if(posit==1)
{P2_1=1;P2_2=0;P2_3=1;}
if(posit==2)
{P2_1=1;P2_2=1;P2_3=0;}
if(++posit>=3)
posit=0;
}
void COMM( void )
{
push_val_left=5; //舵機向左轉90度
timer=0;
while(timer<=4000); //延時400MS讓舵機轉到其位置
StartModule(); //啟動超聲波測距
Conut(); //計算距離
S2=S;
push_val_left=23; //舵機向右轉90度
timer=0;
while(timer<=4000); //延時400MS讓舵機轉到其位置
StartModule(); //啟動超聲波測距
Conut(); //計算距離
S4=S;
push_val_left=13; //舵機歸中
timer=0;
while(timer<=4000); //延時400MS讓舵機轉到其位置
StartModule(); //啟動超聲波測距
Conut(); //計算距離
S1=S;
if((S2<20)||(S4<20)) //只要左右各有距離小于，20CM小車后退
{
backrun(); //后退
timer=0;
while(timer<=4000);
}
if(S2>S4)
{
rightrun(); //車的左邊比車的右邊距離小右轉
timer=0;
while(timer<=4000);
}
else
{
leftrun(); //車的左邊比車的右邊距離大左轉
timer=0;
while(timer<=4000);
}
}
/************************************************************************/
/* PWM調制舵機信號 */
/************************************************************************/
/* 左電機調速 */
/*調節push_val_left的值改變電機轉速,占空比 */
void pwm_Servomoto(void)
{
if(pwm_val_left<=push_val_left)
Sevro_moto_pwm=1;
else
Sevro_moto_pwm=0;
if(pwm_val_left>=200)
pwm_val_left=0;
}
/***************************************************/
///*TIMER1中斷服務子函數產生PWM信號*/
void time1()interrupt 3 using 2
{
TH1=(65536-100)/256; //100US定時
TL1=(65536-100)%256;
timer++; //定時器100US為準。在這個基礎上延時
pwm_val_left++;
pwm_Servomoto();
timer1++; //2MS掃一次數碼管
if(timer1>=20)
{
timer1=0;
Display();
}
}
/************************************************************************/
void sint() interrupt 4 //中斷接收3個字節
{
if(RI) //是否接收中斷
{
RI=0;
dat=SBUF;
if(dat=='O'&&(i==0)) //接收數據第一幀
{
buff[i]=dat;
flag=1; //開始接收數據
}
else
if(flag==1)
{
i++;
buff[i]=dat;
if(i>=2)
{i=0;flag=0;flag_REC=1 ;} // 停止接收
}
}
}
/*********************************************************************/
/*--主函數--*/
void main(void)
{
TMOD=0x11;
TH1=(65536-100)/256; //100US定時
TL1=(65536-100)%256;
TH0=0;
TL0=0;
T2CON=0x34;
T2MOD=0x00;
RCAP2H=0xFF;
RCAP2L=0xDC;
SCON=0x50;
PCON=0x00;
PS=1;
TR1=1;
ET1=1;
ES=1;
EA=1;
delay(100);
push_val_left=13; //舵機歸中
while(1) /*無限循環*/
{
while(flag_xj) //循線標志位
{
if(flag_REC==1)
{
stoprun();
break;
}
if(Left_2_led==0&&Right_1_led==0)
run();
else
{
if(Right_1_led==1&&Left_2_led==0) //右邊檢測到黑線
{
uchar step_l[8]={0xc8, 0x49, 0x61, 0x23, 0x32, 0x16, 0x94, 0x8c}; //右邊兩個電機反轉
}
if(Left_2_led==1&&Right_1_led==0) //左邊檢測到黑線
{
uchar step_r[8]={0x8c, 0x94, 0x16, 0x32, 0x23, 0x61, 0x49, 0xc8}; ;
}
}
}
while(flag_bj) /*無限循環*/
{
if(timer>=1000) //100MS檢測啟動檢測一次
{
timer=0;
StartModule(); //啟動檢測
Conut(); //計算距離
if(S<20) //距離小于20CM
{
stoprun(); //小車停止
COMM(); //方向函數
}
else
if(S>30) //距離大于，30CM往前走
run();
}
if(flag_REC==1)
{
push_val_left=13; //舵機歸中
stoprun();
break;
}
}
if(flag_REC==1) //
{
flag_REC=0;
if(buff[0]=='O'&&buff[1]=='N') //第一個字節為O，第二個字節為N，第三個字節為控制碼
switch(buff[2])
{
case up : // 前進
send_str( );
flag_xj=0;
flag_bj=0;
run();
break;
case down: // 后退
send_str1( );
flag_xj=0;
flag_bj=0;
backrun();
break;
case left: // 左轉
send_str2( );
flag_xj=0;
flag_bj=0;
leftrun();
break;
case right: // 右轉
send_str3( );
flag_xj=0;
flag_bj=0;
rightrun();
break;
case stop: // 停止
send_str4( );
flag_xj=0;
flag_bj=0;
stoprun();
break;
case Car : //
flag_xj=1;
break;
case Car1 : //
flag_bj=1;
break;
}
}
}
}

復制代碼

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