s3010舵机基础上的舵机位置式pid算法实现

k60 DN 144 平台

给与舵机50hz的工作频率为获取较大的工作频率！

在智能车竞赛上测试通过。

const uint16 steering_mid=715;
int16 steer=715;
const uint16 steering_left=620;
const uint16 steering_right=800;
int16 error=0, error_nihe,lasterror=0;
int8 Max_error;extern float Kd;   //
extern float Kp;   //
extern int8 ave;
extern int8 Center_Num;
extern uint8 CentreLineData[60];//保存得到的中线的行数 数组大小为图像行数 60/**************************************************
** 函数名称: void steer_control(void)
** 功能描述: 舵机打脚量控制函数
** 输    入:
** 输    出:
** 说明：
***************************************************/
void SteerControl(void)
{                                                                      error = ave-40;     error_nihe = (int)(Kp*error+Kd*(error-lasterror)); //   if(error_nihe>0)//   {//     error_nihe*=1.113;//   }steer = steering_mid - error_nihe;if(steer>=steering_right){steer=steering_right;    } else if(steer<=steering_left){steer=steering_left;}lasterror=error;Max_error=error;if(Max_error>39){Max_error=39;}else if (Max_error<-39){Max_error=-39;}FTM_PWM_Duty(SD5_FTM,SD5_CH,steer);
}

【算法】舵机位置式pid相关推荐

PID算法：位置式PID和增量式PID
口诀参数整定找最佳, 从小到大顺序查. 先是比例后积分, 最后再把微分加. 曲线振荡很频繁, 比例度盘要放大. 曲线漂浮绕大弯, 比例度盘往小扳. 曲线偏离回复慢, 积分时间往下降. 曲线波动周期长 ...
C语言实现PID算法：位置式PID和增量式PID
原创者微信公众号 PID算法可以说是在自动控制原理中比较经典的一套算法,在现实生活中应用的比较广泛. 大学参加过电子竞赛的朋友都应该玩过电机(或者说循迹小车),我们要控制电机按照设定的速度运转,PID ...
PID控制的深入探讨（位置式PID、增量式PID、PID的积分饱和）
本文主要探讨PID算法在使用时的一些实际问题.处理技巧和方法,学习本节内容需要先对PID控制算法有基本的了解. 1)PID控制的基本原理 PID是一个二阶线性控制器,它具有不需要建立数学模型,控制效果 ...
c语言程序位置式pid算法,位置式PID算法的C语言代码
描述位置式PID的C语言写法详解 PID调节口诀: 参数整定找最佳,从小到大顺序查先是比例后积分,最后再把微分加曲线振荡很频繁,比例度盘要放大曲线漂浮绕大湾,比例度盘往小扳曲线偏离回复慢,积 ...
三菱FX3U PLC 位置式PID算法(ST语言)
三菱PLC自带的PID不必多说,大家可以自行查看指令说明.关于FX3U 增量式PID可以参看专栏的另一篇博客三菱PLC增量式PID算法FB(带死区设置和外部复位控制)_RXXW_Dor的博客-CSD ...
总结PID算法，位置式增量式理解以及C代码实现
前言近日刚接触PID,于是查找了所有资料(PID是经典算法,有很多文章),理解一大堆资料后,整理总结才写下在这篇博客. 自己也用STM32F103写些代码实现验证,先是单纯比例控制,后来PI控制,到 ...
位置式 PID 算法、恩智浦杯智能车电机PID
由于计算机控制是一种采样控制, 它只能根据采样时刻的偏差计算控制量,而不能像模拟控制那样连续输出控制量量, 进行连续控制. 由于这一特点,积分项和微分项不能直接使用,必须进行离散化处理 ...
c语言程序位置式pid算法,增量式与位置式PID算法（C语言实现与电机控制项目）...
4.2核心代码 /************************************************************************** 函数功能:增量PI控制器入口参 ...
位置式PID与增量式PID的介绍和代码实现
PID分为位置式PID与增量式PID. 一.位置式PID 1.表达式为: 2.缺点: 1).由于全量输出,所以每次输出均与过去状态有关,计算时要对ek进行累加,工作量大: 2).因为计算机输出的uk对 ...

【算法】舵机位置式pid

s3010舵机基础上的舵机位置式pid算法实现

【算法】舵机位置式pid相关推荐

最新文章

热门文章