轨迹跟踪算法—

Stanley法核心思想：

Stanley法又称为前轮反馈控制法（Front wheel feedback)，核心在于基于前轮中心的路径跟踪偏差量对方向盘转向控制量进行计算。该算法基于横向跟踪误差为前轴中心到最近路径点的距离的非线性反馈函数，并且能实现横向跟踪误差指数收敛为0。根据车辆位姿与给定路径的几何关系可以直观的获得控制车辆方向盘转角的控制量。

前轮转角控制量由两部分组成：1.由航向误差引起的转角，即当前车身方向与参考轨迹最近的点的切线方向的夹角。2.由横向误差引起的转角，即前轮中心到参考轨迹最近点的横向距离。

模型推导：

跟踪结果图：

纯追踪及LQR的跟踪见：

纯追踪算法(Pure Pursuit) vs 线性二次型(LQR)法_Jeossirey的博客-CSDN博客_purepursuit算法

点击下方卡片，加入会员全年无限制学习后台（MPC各矩阵的底层逻辑、MPC纵向控制、模型验证、MPC自适应巡航控制、非线性系统如何线性化及MPC动力学跟踪任何轨迹、约束添加及新求解器的求解、轨迹规划、纵向规划等80个系列）会员专享爆品课程及资源，同时获得分佣资格，可赚回自己的学费！

轨迹跟踪算法——Stanley法相关推荐

stanley 轨迹跟踪算法
一:简单了解简介:Stanley是一种轨迹跟踪算法: Stanley control low: ComputerControlcmd函数,根据Stanley算法的公式进行代码的编写,所以需要调用接下 ...
LQR轨迹跟踪算法Python/Matlab算法实现_代码(2)
本文根据LQR轨迹跟踪算法Python/Matlab算法实现_LQRmatrix推导(2)使用代码实现,进行仿真: clc clear allKp = 1.0 ; dt =0.1 ;% [s] L = ...
LQR轨迹跟踪算法Python算法实现3
根据LQR轨迹跟踪算法Python/Matlab算法实现2的代码,我们转化成Python,后续上车使用.代码仅开源到这,可以进行仿真,函数都可以直接使用.工程代码就不开源了. from numpy i ...
LQR轨迹跟踪算法Python/Matlab算法实现2
这里对上一篇LQR轨迹跟踪算法Python/Matlab算法实现进行勘误: clc clear allKp = 1.0 ; dt = 0.1 ;% [s] L = 2.9 ;% [m] wheel b ...
LQR轨迹跟踪算法Python/Matlab算法实现_LQRmatrix推导
对于文章 LQR轨迹跟踪算法Python/Matlab算法实现中的LQR推导的问题,我简单写了一下手稿,不高兴做成公式了:
轨迹绕圈算法_基于三次B样条曲线拟合的智能车轨迹跟踪算法
收稿日期:2017-10-30; 修回日期:2017-12-10; 录用日期:2017-12-19. 基金项目: 国家自然科学基金资助项目( 91420202,61372088) . 作者简介: 张永 ...
基于滑模预测控制的海底采矿车轨迹跟踪算法
摘要: 海底采矿车多工作于稀软底质,其面临的外部扰动较大,难以快速收敛跟踪误差,精准地跟踪预设轨迹.为此,本文提出了一种海底采矿车的滑模预测控制(sliding model predictive co ...
carsim+simulink联合仿真实现变道包含路径规划算法+mpc轨迹跟踪算法可选simulink版本和c++版本算法可以适用于弯道道路，弯道车道保持，弯道变道
carsim+simulink联合仿真实现变道包含路径规划算法+mpc轨迹跟踪算法可选simulink版本和c++版本算法可以适用于弯道道路,弯道车道保持,弯道变道 carsim内规划轨迹可视化 ...
carsim+simulink联合仿真实现变道包含路径规划算法+mpc轨迹跟踪算法
carsim+simulink联合仿真实现变道包含路径规划算法+mpc轨迹跟踪算法可选simulink版本和c++版本算法可以适用于弯道道路,弯道车道保持,弯道变道 carsim内规划轨迹可视化 ...
carsim+simulink联合仿真实现变道包含路径规划算法+mpc轨迹跟踪算法带规划轨迹可视化
carsim+simulink联合仿真实现变道包含路径规划算法+mpc轨迹跟踪算法带规划轨迹可视化可以适用于弯道道路,弯道车道保持,弯道变道 Carsim2020.0 ID:5199664465 ...

轨迹跟踪算法——Stanley法

轨迹跟踪算法——Stanley法相关推荐

最新文章

热门文章