无人驾驶车辆路径跟踪的增量式PID控制

路径跟踪是无人车研究方向的一项关键技术。路径跟踪控制算法是指能够使无人车按照预设路径，安全稳定行驶的控制方法。

建立无人车路径跟踪模型

预设无人车在A、B两点间，当前位置为D点，航向为h_F

可以得到BD的距离d_p ；D到AB的垂线段距离d；夹角θp的值；航向角差h△=h_f-hg2；

允许的误差范围为0.2m，在误差范围内和误差范围外的控制策略是不同的

e_k为航向给定量r_k和反馈量c_k的差值，控制器PID的输入量，δ为角度调整值

△u为控制器输出，Kp为比例系数，T_I、T_D分别为积分和微分时间，K_I=1/T_I；K_D=T_D；K_I、K_D分别为积分系数和微分系数

在PID算法中引入积分环节的主要目的是为了减小系统静差，提高系统的控制精度。

微分系数的引入主要是为了改善闭环系统的稳定性和动态响应速度，这是由于微分系统主要影响系统误差变化速率。

由于PID控制器输出是方向盘转角，车辆方向不会瞬时改变太大，因此对其采取限幅措施，得到限幅输出。即方向盘转角每次最多变化的角度。

控制算法的步骤：

1、计算e_k的值：若车在误差带内，e_k=r_k-c_k；若车在误差带外，e_k=r_k-c_k-δ

2、确定积分系数：若e_k的值大于ξ时，K_I=0；若e_k的值小于ξ时，K_I等于设定值

3、确定微分系数：定义误差变动量的平方值为Δｅ^２＝（ｅ_ｋ－ｅ_ｋ－１）^２；KD的值由微分系数分段图得到

4、计算控制器输出△u，确定限幅输出

转载于:https://www.cnblogs.com/shinedaisiki/p/9849482.html

无人驾驶车辆路径跟踪的增量式PID控制相关推荐

位置式和增量式PID控制
PID控制是一个二阶线性控制器定义:通过调整比例.积分和微分三项参数,使得大多数的工业控制系统获得良好的闭环控制性能. 优点 a. 技术成熟 b. 易被人们熟悉和掌握 c. 不需要建立数学模型 d. ...
matlab小车运动轨迹增量式PID控制
1.内容简介略 481-可以交流.咨询.答疑 2.内容说明 PID控制器是一种基于"过去","现在"和"未来"信息估计的简单算法. 常规P ...
C语言实现PID算法：位置式PID和增量式PID
原创者微信公众号 PID算法可以说是在自动控制原理中比较经典的一套算法,在现实生活中应用的比较广泛. 大学参加过电子竞赛的朋友都应该玩过电机(或者说循迹小车),我们要控制电机按照设定的速度运转,PID ...
增量式PID控制算法及仿真
当执行机构需要的是控制量的增量(例如驱动步进电机)时,应采用增量式PID控制.根据递推原理可得: 增量式PID控制算法: 根据增量式PID控制算法,设计了仿真程序,被控对象如下: PID控制参数:kp ...
位置式PID与增量式PID的介绍和代码实现
PID分为位置式PID与增量式PID. 一.位置式PID 1.表达式为: 2.缺点: 1).由于全量输出,所以每次输出均与过去状态有关,计算时要对ek进行累加,工作量大: 2).因为计算机输出的uk对 ...
【转】增量式PID控制算法
(转载出处blog.ednchina.com/tengjingshu )blog.ednchina.com/tengjingshu/211739/message.aspx# 当执行机构需要的不是控制 ...
位置式PID与增量式PID区别浅析
1PID控制算法什么是PID PID 控制器以各种形式使用超过了 1 世纪,广泛应用在机械设备.气动设备和电子设备.在工业应用中PID及其衍生算法是应用最广泛的算法之一,是当之无愧的万能算法 PI ...
基于自适应算法和增量式PID算法的模拟直升飞机控制系统
基于自适应算法和增量式PID算法的模拟直升飞机控制系统文章目录基于自适应算法和增量式PID算法的模拟直升飞机控制系统控制系统硬件单片机系统传感器系统介绍直升机模拟系统介绍系统模块介绍 A ...
位置式PID与增量式PID区别浅析（百度百科增量式PID讲解思路概念更明确清晰）
位置式PID与增量式PID区别浅析 Z小旋 2019-04-26 08:55:12 59882 收藏 713 分类专栏: NXP智能车学习文章标签: 位置式PID PID 增量式PID 版权 1 ...

无人驾驶车辆路径跟踪的增量式PID控制

无人驾驶车辆路径跟踪的增量式PID控制相关推荐

最新文章

热门文章