followline.h

蛇形机器人程序

#ifndef __SENSOR_H__
#define __SENSOR_H__
#include<reg52.h>

#define TIMER0H 0X68
#define TIMER0L 0x68

#define TIMER1H 0X00
#define TIMER1L 0X00

//~~~~~~~~~~~~~~~~
#define Cycle 32

sbit CloseSensor1=P0^4;    //close 1
sbit CloseSensor2=P0^5;	   //right
sbit HozSensor1=P1^0;
sbit HozSensor2=P3^2; 	
sbit TouchSensor1=P0^6; 
sbit TouchSensor2=P0^7;

//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
//~~~~~~~~~For white line~~~~~~~~~~~~~~~~~~
//~~~~~~~~~~~~~~~~~~~~
sbit DriveLeftMo1 = P2^2;
sbit DriveLeftMo2 = P2^3;
sbit DriveRightMo1 = P2^0;
sbit DriveRightMo2 = P2^1;
sbit ReleaseMotor = P0^3;

//~~~~~~~~~~~~~~~~~~
extern bdata unsigned char LineCurStatus;
extern bdata unsigned char LinePreStatus;

extern bit CurStaMidSensor1;
extern bit CurStaMidSensor2;
extern bit CurStaHozSensor1;		//Right
extern bit CurStaHozSensor2;		//Left
extern bit PreStaMidSensor1;
extern bit PreStaMidSensor2;
extern bit PreStaHozSensor1;		//Right
extern bit PreStaHozSensor2;		//Left

extern bit FrontFlag;
extern bit StopFlag;
extern bit BackTouchFlag;
extern bit ClampFlag;
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~
extern unsigned char LineCounterP;		// Downside triggle
extern unsigned char LineCounterN;		// Upside triggle

//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
extern bit FrontFlag; 					//flag of object in the front of the robot
extern unsigned int iFollowLineTime;
extern unsigned int iStopTime;

//~~~~~~~~~~~~~~~~~~~~~~~~~~~
extern unsigned char iLoop;
extern unsigned char iSensorConfirm;
extern unsigned char MidSensor1Confirm ;
extern unsigned char MidSensor2Confirm ;
extern unsigned char HozSensor1Confirm ;
extern unsigned char HozSensor1Confirm ;


//extern unsigned int SpeedRight,SpeedLeft;
// From xiaomao
extern char iRightCounter;			//Current high level Counter
extern char iLeftCounter;		 		
extern char LeftSpeed;
extern char RightSpeed;			// MotorSpeed
extern bit DirectionRight;
extern bit DirectionLeft;		//motor direction

extern const unsigned char LineCrossDelay;
extern unsigned int iStopStatus; //identify the forced to stop
//~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
extern void PWM();	   
extern void Delay(unsigned int time);
extern void SensorSta(void);
extern void UpdateStatus(void);
extern void MotorLeft(char Speed,bit Direction);
extern void MotorRight(char Speed,bit Direction);
extern void Stop(void);
extern void FollowLine(char Speed);	
extern void TurnLeft(char Speed);
extern void TurnRight(char Speed);

//~~~~~~~~~~~~~~~~~~~~~~~~~~~
#endif