智能小車C語言程序

智能小車黑線循跡C語言程序
#include
#include
#define uchar unsigned char
#define uint unsigned int

sbit LeftIR=P1^6; //左邊紅外接收
sbit RightIR=P1^7; //右邊紅外接收
sbit ENA=P1^2; // L298的Enable A
sbit IN1=P1^0; // L298的Input 1
sbit IN2=P1^1; // L298的Input 2
sbit ENB=P1^5; // L298的Enable B
sbit IN3=P1^3; // L298的Input 3
sbit IN4=P1^4; // L298的Input 4
uchar t=0; //中斷計數(shù)器
uchar motor_1=0,motor_2=0; //電機1,2速度值
uchar tmp1,tmp2; // 電機當前速度值
uchar aa; //定時器1中斷計數(shù)
bit flag=0; //標志位


void motor(uchar index, char speed)
{
if(speed>=-100 && speed<=100)
{
if(index==1) // 電機1的處理
{
motor_1=abs(speed); // 取速度的絕對值
if(speed<0) // 速度值為負則反轉(zhuǎn)
{
IN1=0;
IN2=1;
}
else // 不為負數(shù)則正轉(zhuǎn)
{
IN1=1;
IN2=0;
}
}
if(index==2) // 電機1的處理
{
motor_2=abs(speed); // 取速度的絕對值
if(speed<0) // 速度值為負則反轉(zhuǎn)
{
IN3=0;
IN4=1;
}
else // 不為負數(shù)則正轉(zhuǎn)
{
IN3=1;
IN4=0;
}
}
}
}
void init()
{
TMOD=0x12; // 設(shè)定T0的工作模式為2
TH0=0x9B; // 裝入定時器的初值
TL0=0x9B;
TH1=(65536-50000)/256; //設(shè)置初值定時50ms
TL1=(65536-50000)%6;
EA=1; // 開中斷
ET0=1; // 定時器0允許中斷
ET1=1; //定時器1允許中斷
TR0=0; // 關(guān)閉定時器0
TR1=0; // 關(guān)閉定時器0
ENA=0; //關(guān)閉電機1
ENB=0; //關(guān)閉電機2
}
void main()
{
int irDetectLeft,irDetectRight;
init();
while(1)// 電機實際控制演示
{
irDetectRight = RightIR;//右邊接收
irDetectLeft = LeftIR;//左邊接收
if((irDetectLeft==0)&&(irDetectRight==0))//向前進
{
motor(1,100);
motor(2,100);
}
if((irDetectLeft==0)&&(irDetectRight==1))//右轉(zhuǎn)
{
motor(1,-100);
motor(2,100);
}
if((irDetectLeft==1)&&(irDetectRight==0))//左轉(zhuǎn)
{
motor(1,100);
motor(2,-100);
}
if((irDetectLeft==1)&&(irDetectRight==1)&&(flag==0)) //第一次探測定時器1開始計時
{
motor(1,100);
motor(2,100);
TR1=1;
}
if((irDetectLeft==1)&&(irDetectRight==1)&&(flag==1))//第二次探測時小車停
{
TR0=0;
ENA=0;
ENB=0;
}
}
}
void timer0() interrupt 1 // T0中斷服務程序
{
if(t==0) // 1個PWM周期完成后才會接受新數(shù)值
{
tmp1=motor_1;
tmp2=motor_2;
}
if(t ENA=1;
else
ENA=0; // 產(chǎn)生電機1的PWM信號
if(t ENB=1;
else
ENB=0; // 產(chǎn)生電機2的PWM信號
t++;
if(t>=100)
t=0; // 1個PWM信號由100次中斷產(chǎn)生
}
void timer1() interrupt 3
{
TH1=(65536-50000)/256;
TL1=(65536-50000)%6;
aa++;
if(aa==40) //定時2s后小車開始運動
TR0=1;
if(aa==60) //定時3s后置標志位
{
aa=0;
flag=1;
}
}