0.png (74.38 KB, 下載次數: 76)
下載附件
2018-1-18 20:55 上傳
0.png (44.21 KB, 下載次數: 81)
下載附件
2018-1-18 20:53 上傳
單片機源程序如下:
- /****************************************************************************
- 簡單尋跡程序:接法
-
- 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;
- }
-
-
- }
- }
- }
-
復制代碼
所有資料51hei提供下載:
APP整合綜合程序,步進小車.zip
(90.38 KB, 下載次數: 11)
2018-1-17 21:59 上傳
點擊文件名下載附件
下載積分: 黑幣 -5
單獨功能的步進小車接線圖.pdf
(52.59 KB, 下載次數: 10)
2018-1-17 21:59 上傳
點擊文件名下載附件
下載積分: 黑幣 -5
|