20.4-使用两个通道进行PID电磁循迹
面我们没有使用PID完成了循迹
循迹部分代码如下、我们是利用计算的差比和值 根据差比和大小和正负数控制电机,那么我们用PID循迹也是利用这个值,非PID循迹中我们目标是让g_fVoltageOuter 值等于零 ,所以我们每当 g_fVoltageOuter 大于0.5或者小于-0.5时候电机就会发生反应,想做或者右边运动,
PID中也是我们的
目标: 让g_fVoltageOuter变量等于零
输入: 当前g_fVoltageOuter 值
输出: 两个轮子的要控制速度 这里输出一个差速值,两个电机一个加 另一个电机减 这个差速值 就可以控制电机趋向 正确方向运动。
先按照笔记讲解说明,然后按照讲解已经改好的代码,然后教一下如何改代码。比较难理解,大家结合之前篇章多理解学习。
复制一下20.3 的代码 然后再这基础修改。
定义保存PID计算结果的变量
float g_fVoltagePidOut;//电磁循迹PID计算输出
定义一个用于电磁循迹PID参数的结构体
tPid pidVoltage;//电磁循迹PID代码
然后初始化一下PID的参数,给PID参数赋值。这里说一下如何计算PID参数
首先我们先看P I D 的计算函数,这个是我们在电机控制时候写的
我们做电磁循迹 ,循迹不需要关历史累计误差结果,所以我们只用 P D 参数 I=0可以
然后我们做一个假设,假设两次程序第一次g_fVoltageOuter 值是0 、第二次g_fVoltageOuter 是0.5 并且我们知道我们的目标值是零。
然后分析先定P -3 、D 比P 小很多定 -1 。后面我们在调整。
所以我们的PID初始化先这么写
pidVoltage.actual_val=0.0;
pidVoltage.target_val=0.00;//电磁循迹PID 的目标值为0
pidVoltage.err=0.0;
pidVoltage.err_last=0.0;
pidVoltage.err_sum=0.0;
pidVoltage.Kp=-3.00;
pidVoltage.Ki=0;
pidVoltage.Kd=-1.00;
声明一下变量
extern tPid pidVoltage;//电磁循迹PID代码
编写PID控制部分代码
PID输出控制部分代码
g_fVoltagePidOut = PID_realize(&pidVoltage,g_fVoltageOuter);//PID计算输出偏差目标速度 这个速度,会和基础速度加减
g_fHW_PID_Out1 = 1 + g_fVoltagePidOut;//电机1速度=基础速度+电磁PID输出速度
g_fHW_PID_Out2 = 1 - g_fVoltagePidOut;//电机1速度=基础速度-电磁PID输出速度
if(g_fHW_PID_Out1 >5) g_fHW_PID_Out1 =5;//进行限幅 限幅速度在0-5之间
if(g_fHW_PID_Out1 < 0) g_fHW_PID_Out1 =0;
if(g_fHW_PID_Out2 >5) g_fHW_PID_Out2 =5;//进行限幅 限幅速度在0-5之间
if(g_fHW_PID_Out2 < 0) g_fHW_PID_Out2 =0;
motorPidSetSpeed(g_fHW_PID_Out1,g_fHW_PID_Out2);//通过计算的速度控制电机
摇摆十分严重 我们把PD 缩小一些,然后提高基础速度到1.5
PID参数调整如下
pidVoltage.actual_val=0.0;
pidVoltage.target_val=0.00;//电磁循迹PID 的目标值为0
pidVoltage.err=0.0;
pidVoltage.err_last=0.0;
pidVoltage.err_sum=0.0;
pidVoltage.Kp=-1.0; //电磁循迹P参数
pidVoltage.Ki=0;
pidVoltage.Kd=-0.2;//电磁D参数
如果更改了电感,电感的最大电压值可能会变化,需要修改
这个变量
float g_fVoltageMax[4]={2.89,2.89,2.89,2.89};//用于归一化的最大ADC电压采集值 不同赛道要获得更好循迹效果 需要重新采集这个值
审核编辑 黄宇
-
电磁
+关注
关注
15文章
1074浏览量
51708 -
智能车
+关注
关注
21文章
402浏览量
76906 -
循迹
+关注
关注
0文章
14浏览量
13020
发布评论请先 登录
相关推荐
评论