创新设计—自动寻迹小车(6)

2019-05-24 12:16

ADC1SC1=0X02;

for(;!ADC1SC1_COCO;); ad_data[2]=ADC1RL;

ad_add=ad_add+ad_data[2] ; ADC1SC1=0X03;

for(;!ADC1SC1_COCO;); ad_data[3]=ADC1RL;

ad_add=ad_add+ad_data[3] ; ADC1SC1=0X04;

for(;!ADC1SC1_COCO;); ad_data[4]=ADC1RL;

ad_add=ad_add+ad_data[4]; ADC1SC1=0X05;

for(;!ADC1SC1_COCO;); ad_data[5]=ADC1RL;

ad_add=ad_add+ad_data[5] ; ADC1SC1=0X06;

for(;!ADC1SC1_COCO;); ad_data[6]=ADC1RL;

ad_add=ad_add+ad_data[6] ; ADC1SC1=0X07;

for(;!ADC1SC1_COCO;); ad_data[7]=ADC1RL;

ad_add=ad_add+ad_data[7]; ADC1SC1=0X08;

for(;!ADC1SC1_COCO;); ad_data[8]=ADC1RL;

ad_add=ad_add+ad_data[8]; ADC1SC1=0X09;

for(;!ADC1SC1_COCO;); ad_data[9]=ADC1RL;

ad_add=ad_add+ad_data[9] ; ADC1SC1=0X0A;

for(;!ADC1SC1_COCO;); ad_data[10]=ADC1RL;

ad_add=ad_add+ad_data[10]; ADC1SC1=0X0B;

for(;!ADC1SC1_COCO;); ad_data[11]=ADC1RL;

ad_add=ad_add+ad_data[11]; ad_average= ad_add /7;

/*************************************************************************/ if(ad_data[0]>=ad_average) {

26

flag0=1; }

if(ad_data[0]

flag0=0; }

if(ad_data[1]>=ad_average) {

flag1=300; }

if(ad_data[1]

flag1=0; }

if(ad_data[2]>=ad_average) {

flag2=5; }

if(ad_data[2]

flag2=0; }

if(ad_data[3]>=ad_average) {

flag3=700; }

if(ad_data[3]

flag3=0; }

if(ad_data[4]>=ad_average) {

flag4=8; }

if(ad_data[4]

flag4=0; }

if(ad_data[5]>=ad_average) {

flag5=1100; }

if(ad_data[5]

27

flag5=0; }

if(ad_data[6]>=ad_average) {

flag6=13; }

if(ad_data[6]

flag6=0; }

if(ad_data[7]>=ad_average) {

flag7=1500; }

if(ad_data[7]

flag7=0; }

if(ad_data[8]>=ad_average) {

flag8=17; }

if(ad_data[8]

flag8=0; }

if(ad_data[9]>=ad_average) {

flag9=1900; }

if(ad_data[9]

flag9=0; }

if(ad_data[10]>=ad_average) {

flag10=21; }

if(ad_data[10]

flag10=0; }

if(ad_data[11]>=ad_average) {

28

flag11=2300; }

if(ad_data[11]

flag11=0; }

AD=flag0+flag1+flag2+flag3+flag4+flag5+flag6+flag7+flag8+flag9+flag10+flag11;

/**********************************************************************************/

if(right_close==0) {

if(AD== 1) {

Turn=0;mid_flag=0;left_close=1; }

if(AD== 301) {

Turn=1;mid_flag=0;left_close=1; }

if(AD== 300) {

Turn=2;mid_flag=0;left_close=1; }

if(AD== 305) {

Turn=3;mid_flag=0;left_close=1; }

if(AD== 5) {

Turn=4; mid_flag=0;left_close=1; }

if(AD== 705) {

Turn=5; mid_flag=0;left_close=1; }

if(AD== 700) {

Turn=6;mid_flag=0; left_close=1; }

if(AD== 708) {

Turn=7;mid_flag=0; left_close=1; }

if(AD== 8)

29

{

Turn=8; mid_flag=0;left_close=1; } }

if(AD== 1108) {

Turn=9;mid_flag=1;left_close=0;right_close=0; }

if(AD== 1100) {

Turn=10; mid_flag=1;left_close=0;right_close=0; }

if(AD== 1113) {

Turn=11;mid_flag=1;left_close=0;right_close=0; }

if(AD==13) {

Turn=12;mid_flag=1;left_close=0;right_close=0; }

if(AD== 1513) {

Turn=13;mid_flag=1;left_close=0;right_close=0; }

if(left_close==0) {

if(AD== 1500) {

Turn=14; mid_flag=0; right_close=1; }

if(AD== 1517) {

Turn=15; mid_flag=0;right_close=1; }

if(AD== 17) {

Turn=16; mid_flag=0; right_close=1; }

if(AD== 1917) {

Turn=17; mid_flag=0; right_close=1; }

if(AD== 1900) {

30


创新设计—自动寻迹小车(6).doc 将本文的Word文档下载到电脑 下载失败或者文档不完整,请联系客服人员解决!

下一篇:地方政府融资平台及PPP最新政策法规汇编

相关阅读
本类排行
× 注册会员免费下载(下载后可以自由复制和排版)

马上注册会员

注:下载文档有可能“只有目录或者内容不全”等情况,请下载之前注意辨别,如果您已付费且无法下载或内容有问题,请联系我们协助你处理。
微信: QQ: