1位置环和速度环的串级pid,首先要记住,位置环的输出是速度环的输入,最后控制输出为速度环的输出。
速度环的PID控制器 代码如下
float Velocity_KP_A=400,Velocity_KI_A=300;
int Incremental_PI_A (float Encoder,float Target)
{
static float Bias,Pwm,Last_bias;
Bias=Target-Encoder; //Calculate the deviation //计算偏差
Pwm+=Velocity_KP_A*(Bias-Last_bias)+Velocity_KI_A*Bias;
if(Pwm>7200)Pwm=7200;
if(Pwm<-7200)Pwm=-7200;
Last_bias=Bias; //Save the last deviation //保存上一次偏差
return Pwm;
}
速度环只用Kp和Ki控制即可
位置环PID控制器
int Location_pid(float Encoder,float Target)
{
static float Bias,Speed,Last_bias,Integral_bias;
Bias=Target-Encoder; //Calculate the deviation //计算偏差
Integral_bias+=Bias;//求出偏差的积分
Speed+=Location_KP*Bias+Location_KI*Integral_bias+Location_KD*(Bias-Last_bias);
Last_bias=Bias;//保存上次偏差
return Speed;
}
位置环用Kp和Kd即可(只用Kp好像也行的)
2如何将位置环和速度环串在一起
对于位置环
目标为行走的距离,需要转向的度数 (可以把距离与度数转化为脉冲数,方便进行PID控制)
反馈为编码器捕获脉冲数的累计数
每次要用位置环时必须先将脉冲累计数清零
距离转化为脉冲的方法
Target_Encoder_sum_A=distence/(PI*WD)*(EncoderMultiples*MD*Hall_13);
//The encoder octave depends on the encoder initialization Settings
//编码器倍频数,取决于编码器初始化设置
#define EncoderMultiples 4
//Motor_gear_ratio
//电机减速比
#define MD 20
//Number_of_encoder_lines
//编码器精度
#define Hall_13 13
//4WD wheel tire diameter series
//四驱车轮胎直径
#define WD 0.045f
//Encoder data reading frequency
//编码器数据读取频率
#define CONTROL_FREQUENCY 100
//half wheelspacing //半轮距
#define Half_wheelspacing 0.0644f
//half axlespacing //半轴距
#define Half_axlespacing 0.010f
#define PI 3.1415f //PI //圆周率
//这里加将位置环的输入直接编程距离(m)的函数所有普通直行都用这个
void Set_Di
355



被折叠的 条评论
为什么被折叠?



