蓝宙TSL1401设计巡线

2019-08-14 02:03发布

在ADC库函数的例子里面加了下面这个函数来实现在白纸上寻找黑线位置,CCD总是有问题找不到,劳烦各路大神帮忙看一下
u16 CCD_Find(void)
{
u16 ao_d[128];
u16 n,max,min,mid,find=0,bla=0;
GPIO_SetBits(GPIOB,GPIO_Pin_13);
delay_us(50);
GPIO_SetBits(GPIOB,GPIO_Pin_14);
    delay_us(50);
GPIO_ResetBits(GPIOB,GPIO_Pin_13);
delay_us(50);
for(n=0;n<129;n++)
{
GPIO_ResetBits(GPIOB,GPIO_Pin_14);
   delay_us(50);
GPIO_SetBits(GPIOB,GPIO_Pin_14);
        delay_us(50);
}
GPIO_ResetBits(GPIOB,GPIO_Pin_14);
delay_us(50);
GPIO_SetBits(GPIOB,GPIO_Pin_13);
delay_us(50);
GPIO_SetBits(GPIOB,GPIO_Pin_14);
    delay_us(50);
GPIO_ResetBits(GPIOB,GPIO_Pin_13);
delay_us(50);
for(n=0;n<128;n++)
{
ao_d[n]=Get_Adc_Average(ADC_Channel_1,10);
UART0_TX_Oscilloscope(ao_d[n]/10,0);
GPIO_ResetBits(GPIOB,GPIO_Pin_14);
   delay_us(50);
GPIO_SetBits(GPIOB,GPIO_Pin_14);
        delay_us(50);
}
GPIO_ResetBits(GPIOB,GPIO_Pin_14);
delay_us(50);
GPIO_SetBits(GPIOB,GPIO_Pin_14);
max=0;
for(n=0;n<128;n++)
{
if(max<ao_d[n])
   max=ao_d[n];
}
min=max;
for(n=0;n<128;n++)
{
if(min>ao_d[n])    
   min=ao_d[n];
}
mid=(max+min)/2;
for(n=128;n>0;n--)
{
if(ao_d[n-1]<mid)
{
 find=n;
 bla++;
}
}
bla=bla/2;
find=find+bla;
return find;
}
友情提示: 此问题已得到解决,问题已经关闭,关闭后问题禁止继续编辑,回答。