判断黑线状态，归一化，差比和算法

最新推荐文章于 2024-10-27 19:55:47 发布

ooolmf

最新推荐文章于 2024-10-27 19:55:47 发布

阅读量569

点赞数 2

分类专栏：单片机框架F4 文章标签：开发语言

本文链接：https://blog.csdn.net/lmf666/article/details/130877788

版权

单片机同时被 2 个专栏收录

281 篇文章 140 订阅

订阅专栏

框架F4

6 篇文章 0 订阅

订阅专栏

该代码段涉及机器人路径跟踪中的黑线检测。首先，`Judge_Black_Line_Status`函数判断黑线是否存在并确定其状态；然后，`Track_Data_Normalization`对数据进行归一化处理；接着，`Difference_Divide_Sum`计算差比和以评估偏差；最后，`Half_Black_Line_Error`计算单边黑线的误差。这些步骤用于优化机器人沿黑线行进的精度。

摘要由CSDN通过智能技术生成

//判断黑线状态
void Judge_Black_Line_Status(void)
{
	u8 i;
	u8 numb=0;
	u8 position[8];
	
	for(i=0;i<8;i++)
	{
		if(track_data[i]>track_data_range*0.3) black_line_status[i]=0; 
		else black_line_status[i]=1;
	}
	
	for(i=0;i<8;i++)
	{
		if(black_line_status[i]) 
		{
			position[numb]=i;
			numb++;
		}
	}
	//黑线数超过三个舍弃
	if(numb>3) 
	{
		black_line_valid=0;
		black_horizontal_line_flag=1;
	}
	else black_horizontal_line_flag=0;
	
	//丢线
	if(numb==0)
	{
		lost_black_line_flag=1;
	}
	else lost_black_line_flag=0;
	//判断黑线位置是否相邻
	if(numb==1 || \
		(numb==2 && position[0]+1==position[1]) || \
			(numb==3 && position[0]+1==position[1] && position[1]+1==position[2]))
	{
		black_line_valid=1;
	}
	else black_line_valid=0;
}

//归一化
void Track_Data_Normalization(void)
{
	u8 i;
	for(i=0;i<8;i++)
	{
		if(adc_data_fliter[i]>track_data_max[i]) track_data[i]=100;
		else if(adc_data_fliter[i]<track_data_min[i]) track_data[i]=0;
		else track_data[i]=(adc_data_fliter[i]-track_data_min[i])*track_data_range/(track_data_max[i]-track_data_min[i]);
	}
}
//差比和
float Difference_Divide_Sum(void)
{
	float difference,sum;
	difference=4*track_data[0]+3*track_data[1]+2*track_data[2]+track_data[3] \
	-track_data[4]-2*track_data[5]-3*track_data[6]-4*track_data[7];
	sum=track_data[0]+track_data[1]+track_data[2]+track_data[3] \
	+track_data[4]+track_data[5]+track_data[6]+track_data[7];
	if(sum) difference=100*difference/sum;
	else difference=0;
	if(difference>100) difference=100;
	else if(difference<-100) difference=-100;
  return (difference);
}
//单边线求偏差
float Half_Black_Line_Error(void)
{
	u8 i;
	for(i=0;i<4;i++)
	{
		if(black_line_status[i]) break;
	}
	return ((4-i)-1)*9;
}