20.3-使用两个通道进行电磁循迹智能车竞赛电磁杆原理图电磁循迹小车智能车电磁组 STM32电磁小车电磁循迹小车电磁循迹算法智能车环岛智能车比赛规则归一化处理差比和计算 PID算

最新推荐文章于 2024-09-13 19:40:24 发布

好家伙VCC

最新推荐文章于 2024-09-13 19:40:24 发布

阅读量890

点赞数 9

分类专栏： V3-V3.3.0STM32智能小车文章标签： stm32 算法嵌入式硬件笔记单片机 51单片机 arm开发

本文链接：https://blog.csdn.net/qq_46187594/article/details/141223829

版权

V3-V3.3.0STM32智能小车专栏收录该内容

26 篇文章 311 订阅

订阅专栏

功能介绍放开头，使用便捷无需愁。
这是全网最详细、性价比最高的STM32实战项目入门教程，通过合理的硬件设计和详细的视频笔记介绍，硬件使用STM32F103主控资料多方便学习，通过3万字笔记、12多个小时视频、20多章节代码手把手教会你如何开发和调试。让你更快掌握嵌入式系统开发。
V3.3.0-STM32智能小车
视频: https://www.bilibili.com/video/BV16x4y1M7EN/?spm_id_from=333.337.search-card.all.click添加链接描述
V3:HAL库开发、功能：PID速度控制、PID循迹、PID跟随、遥控、避障、PID角度控制、视觉控制、电磁循迹、RTOS等功能。

20.3-使用两个通道进行电磁循迹

我们知道了V1和V4的电压值、这个电压值正比于电感垂直放置在磁导线的距离，那么我们很容易就容易想到使用二者差值表示小车偏转方向和大小。

比如一次测量: V4:0.63 V1 :0.50 那么用 V4-V1 = 0.63-0.50=0.13 大于零表示往V4方向偏，0.13表示偏转大小

但是这个计算方法有个坏处，我们举例，假设小车位置不变，但是因为赛道线长度，电磁信号不同等原因，所以信号会整体发生变化，我们假设电压都提升10%，那么就是

V4: 0.63*1.1= 0.693

V1:0.50*1.1= 0.55

0.693 - 0.55 = 0.143

发现 0.143 和之前的0.13 还是有变化的。

那么尝试换个计算方法使用差比和计算方法：(a-b)/(a+b) 计算：V4:0.63 V1 :0.50、然后(0.63-0.50)/(0.63+0.50) 结果是：0.13/1.13=

0.11504

(a-b)/(a+b) 计算：( 0.693-0.55)/(0.693+0.55)：0.143/1.243 = 0.11504

这样发现值就是相同的。

在这里插入图片描述

归一化处理:

进行归一化处理的原因是:是根据电感值在对应赛道到的最大值max，把根据这个max,然后再根据采集值value，使用value/max * 100 这个公式计算数据处理到对应0-100的值，这样的好处的是：在更换赛道后，测量新的赛道的最大值，改变max值即可，有较强适应性。
在这里插入图片描述

float g_fVoltageMax[4]={2.89,2.89,2.89,2.89};//用于归一化的最大ADC电压采集值 不同赛道要获得更好循迹效果 需要重新采集这个值
int   g_iVoltageGuiYi[4];//这个是四个通道归一化的结果，用0-100表示每个通道电压大小

使用归一化的公式进行计算
在这里插入图片描述

	/**归一化处理**/  
	for(int i=0;i<4;i++)
	{
		if(g_fVoltage[i] > g_fVoltageMax[i]) g_fVoltage[i] = g_fVoltageMax[i];//进行限幅
		g_iVoltageGuiYi[i] = g_fVoltage[i]/g_fVoltageMax[i]*100;//进行归一化计算转化到0-100
	}

进行差比和计算:

使用差比和原因: 可以直观反映小车偏离方向和程度，通过正负反映小车偏移方向，通过绝对值大小反映偏移程度。

定义两个变量

float g_fVoltageOuter;//电感杆外面两个电感差比和值 电感4和电感1 
float g_fVoltageInterior;//电磁杆中间两个电感差比和值 电感2和电感3

在这里插入图片描述
使用差比和计算公式进行

注意使用放置截断使用(float) 进行转化

	/*差比和值表示小车的偏差 差比和计算公式 (a-b)/(a+b)这个值表示小车的偏差  */
	/* 下面是使用归一化的值进行差比值计算*/
	/*增加(float)的原因是转化成浮点数，防止整数除法时候出现截断现象*/
	g_fVoltageOuter = (float)((g_iVoltageGuiYi[3]-g_iVoltageGuiYi[0])/(float)(g_iVoltageGuiYi[3]+g_iVoltageGuiYi[0] +1));//外面两个电感差比和值 电感4和电感1 "-1"是因为要和数组索引对应
	g_fVoltageInterior = (float)((g_iVoltageGuiYi[2]-g_iVoltageGuiYi[1])/(float)(g_iVoltageGuiYi[2]+g_iVoltageGuiYi[1] +1));//里面两个电感差比和值 电感2和电感3

利用差比和值进行循迹:

根据差比和值正负和绝对值大小进行调整运动方向

	/*利用差比和值进行循迹*/
	if(0.75 > g_fVoltageOuter > 0.5)
	{
		motorPidSetSpeed(1,0.8);//左边运动 这个值可能需要根据自己轨道特点调整
	}
	else if(0.75 <= g_fVoltageOuter)// 检测小车位置到更加右偏了
	{
		motorPidSetSpeed(1.2,0.2);//更向左边运动 这个值可能需要根据自己轨道特点调整
	}
	else if(-0.75 < g_fVoltageOuter < -0.5)
	{
		motorPidSetSpeed(0.8,1);//右边运动 这个值可能需要根据自己轨道特点调整
	}
	else if( -0.75 >= g_fVoltageOuter)// 检测小车位置到更加左偏了
	{
		motorPidSetSpeed(0.2,1.2);//更向右边运动 这个值可能需要根据自己轨道特点调整
	}
	else{		
		motorPidSetSpeed(1,1);//前运动	
	}

在这里插入图片描述

显示屏幕方便调试：

调整把上面的一些数据显示在OLED，其实这部应该先做，先把一些计算的结果显示在OLED上，这样方便调试

	sprintf((char*)OledString, "O:%.2f  I:%.2f  ", g_fVoltageOuter,g_fVoltageInterior);//显示差比和值 O: 这个是外面两个差比和值计算结果 I:这个
	OLED_ShowString(0,1,OledString,12);//这个是oled驱动里面的，是显示位置的一个函数，
	
	sprintf((char*)OledString, "G1:%d  G2:%d   ", g_iVoltageGuiYi[0],g_iVoltageGuiYi[1]);//显示归一化后的数据 G1:电感1差比和值 G2 :电感2差比和值
	OLED_ShowString(0,2,OledString,12);//这个是oled驱动里面的，是显示位置的一个函数，
		
	sprintf((char *)OledString,"G3:%d  G4:%d   ",g_iVoltageGuiYi[2],g_iVoltageGuiYi[3]);//显示归一化后的数据 G3:电感3差比和值 G4:电感4差比和值
	OLED_ShowString(0,3,OledString,12);//这个是oled驱动里面的，是显示位置的一个函数，
	
	sprintf((char *)OledString,"v1:%.2f v2:%.2f ",g_fVoltage[0],g_fVoltage[1]);//显示 1、2 电压值  V1:电感1值 V2:电感2值
	OLED_ShowString(0,4,OledString,12);//这个是oled驱动里面的，是显示位置的一个函数，
	
	sprintf((char *)OledString,"v3:%.2f v4:%.2f ",g_fVoltage[2],g_fVoltage[3]);//显示3、4 电压值   V3;电感3值 V4:电感4值
	OLED_ShowString(0,5,OledString,12);//这个是oled驱动里面的，是显示位置的一个函数，