|
|
|
#include<reg51.h> #include<math.h> #define uchar unsigned char #define uint unsigned int #define N 40 #define M 40 sbit en1=P1^0; /* L298的Enable A */ sbit s1=P1^1; /* L298的Input 1 */ sbit s2=P1^2; /* L298的Input 2 */ sbit s3=P1^3; /* L298的Input 3 */ sbit s4=P1^4; /* L298的Input 4 */ sbit en2=P1^5; /* L298的Enable B */ uchar t=0; /* 中斷計(jì)數(shù)器 */ uchar m1=0; /* 電機(jī)1速度值 */ uchar m2=0; /* 電機(jī)2速度值 */ uchar tmp1,tmp2; /* 電機(jī)當(dāng)前速度值 */ uchar KAI=1; /* 電機(jī)控制函數(shù) index-電機(jī)號(hào)(1,2); speed-電機(jī)速度(0-100) */ void Back(void) { s1=0; s2=1; s3=1; s4=0; } void GO(void) { s1=1; s2=0; s3=1; s4=0; } void TL(void) { s1=1; s2=0; s3=0; s4=1; } void TR(void) { s1=0; s2=1; s3=1; s4=0; } void Stop(void) { s1=1; s2=1; s3=1; s4=1; } void delay(uint j) /* 簡(jiǎn)易延時(shí)函數(shù) */ { for(j;j>0;j--); } void main() { uchar i=0,j=0,SHOU,ii=0,jj=0; uchar flag=0; SCON=0X50; TMOD=0x22; /* 設(shè)定T0的工作模式為2 ,8位自動(dòng)重置定時(shí)器，沒過幾個(gè)機(jī)器周期，計(jì)數(shù)器加一*/ TH0=0x9B; /* 裝入定時(shí)器的初值，計(jì)數(shù)100次溢出 */ TL0=0x9B; /*裝入時(shí)間常數(shù)*/ EA=1; /* 開中斷 */ ET0=1; /* 定時(shí)器0允許中斷 */ TR0=1; /* 啟動(dòng)定時(shí)器0 */ PCON=0X00; TH1=0XFd; TL1=0XFd; TR1=1; m1=50; m2=50; while(1) { if(RI==1) { SHOU=SBUF; RI=0; if(SHOU>6) SHOU=0; } switch(SHOU) { case 0: Stop();break; case 1: GO();break; case 2: TR();delay(5000);SHOU=0; break; case 3: TL();delay(5000);SHOU=0; break; case 4: Back();break; case 5: GO();delay(5000);SHOU=0; break; case 6: Back();delay(5000);SHOU=0; } } } void timer0() interrupt 1 /* T0中斷服務(wù)程序 */ { if(t==0) /* 1個(gè)PWM周期完成后才會(huì)接受新數(shù)值 */ { tmp1=m1; tmp2=m2; } if(t<tmp1) en1=1; else en1=0; /* 產(chǎn)生電機(jī)1的PWM信號(hào) */ if(t<tmp2) en2=1; else en2=0; /* 產(chǎn)生電機(jī)2的PWM信號(hào) */ t++; if(t>=100) t=0; /* 1個(gè)PWM信號(hào)由100次中斷產(chǎn)生 */ } |
|
