quguang.c

来自「具有寻黑带、趋光、避障功能」· C语言 代码 · 共 16 行

/********************趋光***********************/
#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;
}