|
|
#include<reg52.h>
#include<math.h>
#define uchar unsigned char
#define uint unsigned int
uchar Buffer[4] = {0}; //從串口接收的數(shù)據(jù)
void delay(uint t);
uint i,j;
////////////////////////////
////////////電機(jī)轉(zhuǎn)動(dòng)
sbit P30=P2^0;
sbit P31=P2^1;
sbit P32=P2^2;
sbit P33=P2^3;
/////////pwm調(diào)試使能端
sbit ENA=P0^0;
sbit ENB=P0^1;
////////////////////////////
#define Right_moto_pwm P0^0 //接驅(qū)動(dòng)模塊ENA使能端輸入PWM信號調(diào)節(jié)速度
#define Left_moto_pwm P0^1 //接驅(qū)動(dòng)模塊ENB使能端輸入PWM信號調(diào)節(jié)速度
///////////////定義電機(jī)轉(zhuǎn)動(dòng)方向
#define Left_moto_back {P30=1,P31=0;} //左電機(jī)后退
#define Left_moto_go {P30=0,P31=1;} //左電機(jī)前進(jìn)
#define Left_moto_stop {P30=1,P31=1;} //左電機(jī)停轉(zhuǎn)
#define Right_moto_back {P32=1,P33=0;} //右電機(jī)后退
#define Right_moto_go {P32=0,P33=1;} //右電機(jī)前轉(zhuǎn)
#define Right_moto_stop {P32=1,P33=1;}
/////////////////////////////
uchar pwm_val_left =0;
uchar push_val_left =0; //左電機(jī)占空比N/10
uchar pwm_val_right =0;
uchar push_val_right=0; //右電機(jī)占空比N/10
bit Right_moto_stp=1;
bit Left_moto_stp =1;
uint num,i,d,j=0;
/********************************************************************
* 名稱 : Delay_1ms()
* 功能 : 延時(shí)子程序，延時(shí)時(shí)間為 1ms * x
* 輸入 : x (延時(shí)一毫秒的個(gè)數(shù))
* 輸出 : 無
***********************************************************************/
void Delay_1ms(uint i)//1ms延時(shí)
{
uchar x,j;
for(j=0;j<i;j++)
for(x=0;x<=148;x++);
}
void run(void) //前進(jìn)函數(shù)
{
push_val_left =17; //PWM 調(diào)節(jié)參數(shù)1-20 1為最慢20是最快 改這個(gè)值可以改變其速度
push_val_right =17; //PWM 調(diào)節(jié)參數(shù)1-20 1為最慢20是最快 改這個(gè)值可以改變其速度
Left_moto_go ; //左電機(jī)前進(jìn)
Right_moto_go ; //右電機(jī)前進(jìn)
}
void run1(void)//前進(jìn)函數(shù)1
{
push_val_left =4; //PWM 調(diào)節(jié)參數(shù)1-20 1為最慢20是最快 改這個(gè)值可以改變其速度
push_val_right =4; //PWM 調(diào)節(jié)參數(shù)1-20 1為最慢20是最快 改這個(gè)值可以改變其速度
Left_moto_go ; //左電機(jī)前進(jìn)
Right_moto_go ; //右電機(jī)前進(jìn)
}
void run2(void)//前進(jìn)函數(shù)1
{
push_val_left =21; //PWM 調(diào)節(jié)參數(shù)1-20 1為最慢20是最快 改這個(gè)值可以改變其速度
push_val_right =21; //PWM 調(diào)節(jié)參數(shù)1-20 1為最慢20是最快 改這個(gè)值可以改變其速度
Left_moto_go ; //左電機(jī)前進(jìn)
Right_moto_go ; //右電機(jī)前進(jìn)
}
/****************************************************************
********/
void left(void) //左轉(zhuǎn)函數(shù)
{
push_val_left =19;
push_val_right =19;
Right_moto_go; //右電機(jī)繼續(xù)
Left_moto_stop; //左電機(jī)停走
}
void left1(void) //左轉(zhuǎn)函數(shù) 1
{
push_val_left =20;
push_val_right =20;
Right_moto_go; //右電機(jī)繼續(xù)
Left_moto_stop; //左電機(jī)停走
}
/*************************************** *********************************/
void right(void) //右轉(zhuǎn)函數(shù)
{
push_val_left =19;
push_val_right =19;
Right_moto_stop; //右電機(jī)停走
Left_moto_go; //左電機(jī)繼續(xù)
}
void right1(void) //右轉(zhuǎn)函數(shù)1
{
push_val_left =20;
push_val_right =20;
Right_moto_stop; //右電機(jī)停走
Left_moto_go; //左電機(jī)繼續(xù)
}
///////////////////////////////////////////////////////////////停止
void stop(void)
{
Right_moto_stop; //右電機(jī)停走
Left_moto_stop; //左電機(jī)停走
//run();
//
//Delayms(100);
}
///////////////////////////////////////////
void zzhijiao()
{
push_val_left =19;
push_val_right =19;
Left_moto_go ; //左電機(jī)前進(jìn)
Right_moto_back ;
}
///////////////////////////////////////
void yzhijiao()
{
push_val_left =19;
push_val_right =19;
Left_moto_back ; //左電機(jī)前進(jìn)
Right_moto_go ;}
void backward(void)//后退
{
push_val_left =15; //PWM 調(diào)節(jié)參數(shù)1-20 1為最慢20是最快 改這個(gè)值可以改變其速度
push_val_right =15; //PWM 調(diào)節(jié)參數(shù)1-20 1為最慢20是最快 改這個(gè)值可以改變其速度
Left_moto_back; //左電機(jī)前進(jìn)
Right_moto_back ; //右電機(jī)前進(jìn)
}
/*************************PWM調(diào) 制 電 機(jī) 轉(zhuǎn) 速
********************************/
void pwm_out_left_moto(void) //左電機(jī)調(diào)速,調(diào)節(jié)push_val_left的值改變電機(jī)轉(zhuǎn)速,占空比
{
if(Left_moto_stp)
{
{if(pwm_val_left<=push_val_left)
{ ENB=1;}
else
{ENB=0;}
}
{if(pwm_val_left>=20)
{pwm_val_left=0;}
}
}
else
{ENB=0;}
}
void pwm_out_right_moto(void) //右電機(jī)調(diào)速,調(diào)節(jié)push_val_left的值改變電機(jī)轉(zhuǎn)速,占空比
{
if(Right_moto_stp)
{
if(pwm_val_right<=push_val_right)
{ENA=1;}
else
{ENA=0;}
if(pwm_val_right>=20)
{pwm_val_right=0;}
}
else
{ENA=0;}
}
/********************************************************************
* 名稱 : Com_Int()
* 功能 : 串口中斷子函數(shù)
* 輸入 : 無
* 輸出 : 無
***********************************************************************/
void Com_Int(void) interrupt 4
{
EA = 0;
if(RI == 1) //當(dāng)硬件接收到一個(gè)數(shù)據(jù)時(shí)，RI會(huì)置位
{
Buffer[0] = SBUF - 48; //這里減去48是因?yàn)閺碾娔X中發(fā)送過來的數(shù)據(jù)是ASCII碼。
RI = 0;
}
EA = 1;
}
/********************************************************************
* 名稱 : Com_Init()
* 功能 : 串口初始化，晶振11.0592,波特率9600，使串口中斷
* 輸入 : 無
* 輸出 : 無
***********************************************************************/
void Com_Init(void)
{
TMOD = 0x20;
PCON = 0x00;
SCON = 0x50;
TH1 = 0xFd; //設(shè)置波特率 9600
TL1 = 0xFd;
TR1 = 1; //啟動(dòng)定時(shí)器1
ES = 1; //開串口中斷
EA = 1; //開總中斷
}
void Init_Timer0()interrupt 1 using 2
{
TH0=0XFC; //2Ms定時(shí)
TL0=0X30;
pwm_val_left++;
pwm_val_right++;
pwm_out_left_moto();
pwm_out_right_moto();
}
void main()
{
Delay_1ms(100);
Com_Init();//串口初始化
TMOD |=0X01;
TH0= 0XFC; //2ms定時(shí)
TL0= 0X30;
TR0= 1;
ET0= 1;
stop();
delay(5000);
delay(5000);
delay(5000);
delay(5000);
while(1)
{
switch(Buffer[0])
{
case 0: run(); break;
case 1: left(); break;
case 2: right(); break;
case 3: zzhijiao(); break;
case 4: yzhijiao(); break;
case 5: run1(); break;
case 6: stop(); break;
case 7: backward();break;
default:break;
}
}
}
void delay(unsigned int t)
{
while(--t);
}
|
-
-
藍(lán)牙小車.rar
2017-10-27 15:27 上傳
點(diǎn)擊文件名下載附件
下載積分: 黑幣 -5
25.21 KB, 下載次數(shù): 24, 下載積分: 黑幣 -5
|
