quguang.c

具有寻黑带、趋光、避障功能

/********************趋光***********************/
#include<stdio.h>
#include<reg52.h>
#include"tdp.h"

extern uchar DACdata[3];
void QuGuang(void)
{
	char i=0;
	if(DACdata[1]>DACdata[0])i=1;
	if(DACdata[2]>DACdata[1])i=2;
	if(i==0)QIAN;
	else if(i==2)YOUGUAI;
	else ZUOGUAI;
	if(DACdata[0]<150&DACdata[1]<150&DACdata[2]<150)TING;
}