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