簡單紅外避障小車單片機程序

ID:497325 · 發(fā)表于 2019-6-2 14:35

這次的紅外避障實驗小車程序適合于初學者。

注意：每個小車轉速等特性都會不同，具體的轉向避障程序塊兒可以自己試著調試
要有耐心。

單片機源程序如下:

#include<reg51.h>
#include<intrins.h>
#define uint unsigned int
#define uchar unsigned char
#define Left_moto2_pwm qy_enb
#define Right_moto2_pwm qz_ena
#define Left_moto_pwm hy_enb
#define Right_moto_pwm hz_ena
void delay(uint i)
{
uint j,k;
for(j=i;j>0;j--)
for(k=114;k>0;k--);
}
sbit out_left=P2^0;
sbit out_right=P2^1;
//定義電機IO口
sbit qz_ena=P1^0;
sbit qz_in1=P1^1;
sbit qz_in2=P1^2;
sbit qy_enb=P1^3;
sbit qy_in3=P1^4;
sbit qy_in4=P1^5;
sbit hz_ena=P1^6;
sbit hz_in1=P1^7;
sbit hz_in2=P2^2;
sbit hy_enb=P2^6;
sbit hy_in3=P2^4;
sbit hy_in4=P2^5;
//定義數(shù)據(jù)部分
bit Right_moto_stop=1;
bit Left_moto_stop =1;
unsigned int time=0;
int pwm=3;
unsigned char pwm_val_left =0;//變量定義
unsigned char push_val_left =0;// 左電機占空比N/10
unsigned char pwm_val_right =0;
unsigned char push_val_right=0;// 右電機占空比N/10
/************************************************************************/
void run(void) //pwm調速函數(shù)
{
push_val_left =pwm; //PWM 調節(jié)參數(shù)1-10 1為最慢，10是最快改這個值可以改變其速度
push_val_right =pwm; //PWM 調節(jié)參數(shù)1-10 1為最慢，10是最快改這個值可以改變其速度
if(pwm==10) pwm=0;
if(pwm==0&&pwm<0) pwm=0;
}
/************************************************************************/
/* PWM調制電機轉速 */
/************************************************************************/
/* 左側電機調速 */
/*調節(jié)push_val_left的值改變電機轉速,占空比 */
void pwm_out_left_moto(void)
{
if(Left_moto_stop)
{
if(pwm_val_left<=push_val_left)
{ Left_moto_pwm=1;
Left_moto2_pwm=1; }
else
{ Left_moto_pwm=0;Left_moto2_pwm=0; }
if(pwm_val_left>=10)
pwm_val_left=0;
}
else { Left_moto_pwm=0;Left_moto2_pwm=0; }
}
/******************************************************************/
/* 右側電機調速 */
void pwm_out_right_moto(void)
{
if(Right_moto_stop)
{
if(pwm_val_right<=push_val_right)
{ Right_moto_pwm=1;
Right_moto2_pwm=1; }
else
{Right_moto_pwm=0;
Right_moto2_pwm=0;}
if(pwm_val_right>=10)
pwm_val_right=0;
}
else {Right_moto_pwm=0;Right_moto2_pwm=0; }
}
/***************************************************************************/
void Forward(void)//前進
{
ET0=1;
run();
qz_in1=0;//右后輪
qz_in2=1;
qy_in3=1;//后坐
qy_in4=0;
hz_in1=1; //前右
hz_in2=0;
hy_in3=1; //前左
hy_in4=0;
}
void Stop(void) //停車
{
qz_in1=0;
qz_in2=0;
qy_in3=0;
qy_in4=0;
hz_in1=0;
hz_in2=0;
hy_in3=0;
hy_in4=0;
}
void back(void) //后退
{
ET0=1;
run();
qz_in1=1;
qz_in2=0;
qy_in3=0;
qy_in4=1;
hz_in1=0;
hz_in2=1;
hy_in3=0;
hy_in4=1;
}
void Turn_Right(void) //向右旋轉
{
ET0=1;
run();
qz_in1=0;
qz_in2=0;
qy_in3=1;
qy_in4=0;
hz_in1=1;
hz_in2=0;
hy_in3=0;
hy_in4=0;
}
void Turn_Left()
{
ET0=1;
run();
qz_in1=0;
qz_in2=1;
qy_in3=0;
qy_in4=0;
hz_in1=0;
hz_in2=0;
hy_in3=1;
hy_in4=0;
}
void main()
{
//用于初始化pwm調速
TMOD=0X01;
TH0= 0XF8; //1ms定時
TL0= 0X30;
TR0= 1;
ET0= 1;
EA = 1;
while(1)
{
//有信號為0 沒有信號為1
if(out_left==1&&out_right==1)
{
pwm=3;
Forward(); //調用前進函數(shù)
}
if(out_left==1&&out_right==0) //右邊檢測到障礙物
{
pwm=5;
back();
delay(300);
Turn_Left; //調用小車左轉函數(shù)
delay(500);
}
if(out_left==0&&out_right==1 ) //左邊檢測到障礙物
{
pwm=5;
back();
delay(300);
Turn_Right(); //調用小車右轉函數(shù)
delay(500);
}
if(out_left==0&&out_right==0 ) //左邊檢測到障礙物
{
pwm=3;
back(); //調用小車右轉函數(shù)
}
}
}
///*TIMER0中斷服務子函數(shù)產(chǎn)生PWM信號*/
void timer0()interrupt 1 using 2
{
TH0=0XF8; //1Ms定時
TL0=0X30;
time++;
pwm_val_left++;
pwm_val_right++;
pwm_out_left_moto();
pwm_out_right_moto();
}
/* if(out==0) //距離在范圍內(nèi)0 快要撞了
{
Stop();
back();
delay(1000);
}
else //距離超出定值1 離墻還遠
{
Stop();
Forward();
}*/

復制代碼

所有資料51hei提供下載:

紅外避障.zip (22.3 KB, 下載次數(shù): 140)

ID:783876 · 發(fā)表于 2020-6-19 10:13

謝謝樓主分享

ID:931523 · 發(fā)表于 2021-6-4 22:51

代碼很好，很適合初學者

ID:922888 · 發(fā)表于 2021-7-7 15:41

代碼不錯，值得學習
謝謝

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

簡單紅外避障小車單片機程序

評分