car.c

来自「基于51单片机与GPS系统的智能坦克车源代码+PROTUES仿真+电路图。欢迎下」· C语言 代码 · 共 49 行

/*************************************
    SUPER TANKING感光及电机驱动程序
    作者：
***************************************/

//L298N的IN1～IN4以及ENA，ENB连接单片机的信号输出P1.0～P1.5；

#include <reg51.h>

sbit zuo=P2^0;		//左感光
sbit you=P2^1;		//右感光
sbit lan1=P2^6;			//蓝色LED1
sbit lan2=P2^7;			//蓝色LED1
sbit lv2=P2^2;		//绿色LED1
sbit lv1=P2^3;		//绿色LED1
sbit hong2=P2^4;		//红色LED1
sbit hong1=P2^5;		//红色LED2
#define QIAN 0X1B 	//机器人前进驱动码
#define HOU  0X2D 	//机器人后退驱动码
#define ZUOQIAN 0X3	 //机器人左前驱动码
#define YOUQIAN 0X18	 //机器人右前驱动码
#define YOUHOU 0X28 	//机器人右后驱动码
#define ZUOHOU 0X5 	//机器人左后驱动码

void main()
{
	while(1)
	{
	hong1=1;hong2=1;lv1=1;lv2=1;
		lan1=0;
		lan2=0;
		zuo=1;
		you=1;
		if(zuo==0&you==0)
		{P1=QIAN;
		lv1=0;lv2=0;}
		else if(zuo==1&you==0)
		{P1=ZUOQIAN;
		lv1=1;lv2=1;hong2=0;}
		else if(you==1&zuo==0)
		{P1=YOUQIAN;
		hong2=1;hong1=0;}
		else if(you==1&zuo==1)
		{P1=0x1d;     //原地打转驱动码
		hong2=0;lv1=0;lv2=0;}
	}

}