51单片机实现光源的跟踪
加入技术交流群
西安理工大学--自动化与信息工程学院
邹艺良 编写（2014.08.25）
邮箱：262276047@qq.com
//*******************************
//西安理工大学--自动化与信息工程学院--邹艺良
//*******************************
unsigned int ch0,ch1;
int value,chazhi,z1,z2,z3,z4,gap;
gap=30;
while(1)
{
uart_init();
ADC_init();
//显示左右两传感器电压
ch0=show_ADC_result_ch0();
//通道ch0电压
Send(0x20); //四个空格符
Send(0x20);
Send(0x20);
Send(0x20);
ch1=show_ADC_result_ch1();
//通道ch1电压
Send(0x20); //四个空格符
Send(0x20);
Send(0x20);
Send(0x20);
//显示差值电压
value=ch0-ch1;
if(ch0>ch1)
{chazhi=ch0-ch1;}
else
{chazhi=ch1-ch0;}
z1=chazhi/1000;
z2=chazhi00/100;
z3=chazhi000/10;
z4=chazhi000;
Send(0x43);
//C
Send(0x3D);
//=
if(ch0
{Send(0x2D);}
else
{Send(0x2B);}
Send(z1+48);
Send(0x2E);
//.
Send(z2+48);
Send(z3+48);
Send(z4+48);
if((ch0+gap)
{Send(0x52);}
if(ch0>(ch1+gap))
{Send(0x4C);}
if(-gap<(ch0-ch1) || (ch0-ch1)
{Send(0x20);}
//Send(0xD);
//回车
//Send(0xA);
//换行
//光源跟踪
if(-gap
stop_turn();
else if(value<-gap)
negative_turn(10);
else if(value>gap)
positive_turn(10);
//for(p=0;p<50;p++)
//延时1s刷新一次
//{delay_10ms();}
}
unsigned int result;
ADC_CONTR=0x88|ch;
//开启AD，选择通道
_nop_();
_nop_();
_nop_();
_nop_();
while(!(ADC_CONTR & 0x10));//等待转换完成，FLAG标志位置位
ADC_CONTR&=0x67; //关AD,清FLAG
01100111
result=ADC_RES*4+ADC_RESL; //获取10位结果
return(result);
#include
#include
#include
void ADC_init();
int get_ADC_result(char ch);
unsigned int show_ADC_result_ch0();
unsigned int show_ADC_result_ch1();
void Send(unsigned char dat);
void uart_init();
void delay(unsigned int a);
void delay_10ms();
sbit P2_0=P2^0;
sbit P2_1=P2^1;
sbit P1_3=P1^3;
void positive_turn(unsigned int count); //顺时针
void negative_turn(unsigned int count); //逆时针
void stop_turn();
void main()
{
}
void ADC_init()
{
P1ASF=0x03;//设置P1.0,P1.1为AD转换口
ADC_CONTR=0x80;//打开AD电源、选择转换速度、
ADC_RES=0;
ADC_RESL=0;
AUXR1&=0xfb;
//设置AD转换结果存放方式，此设为10位
delay(5);
}
int get_ADC_result(char ch)
{
}
评论