Pure Persuit算法基础

ROS实现无人驾驶控制算法(一)——pure pursuit 轨迹跟踪主要分为两类:基于几何追踪的方法和基于模型预测的方法。而pure pursuit算法就是最基本的基于几何的控制算法,因其鲁棒性高,对路径的要求低而广泛使用,也为后续的standly、LQR、MPC算法打好基础。因为纯追踪算法是基于几何模型的,因此,需要推导出车辆的运动学模型,本文采用的是阿克曼模型(差速模型也会提及)。对于阿克曼转向模型来说,只需要驱动电机控制线速度,以及前轮舵机转角控制转向,因此,需要计算前轮转向角的求导公式。3.从该路径点出发,沿着路径寻找大于前视距离的第一个点作为目标点。 阅读详情

纯跟踪(Pure Pursuit)算法是一种用于移动机器人或自动驾驶车辆的路径跟踪方法。其基本目标是让机器人沿着预定路径行驶,同时保持一定的参考速度。在给定线速度的前提下,它计算移动的角速度令机器人从其当前位置到达机器人前方的某个前瞻点(lookahead)。该算法根据机器人的当前位置不断地追着它前面的一个点,直到路径的最后一个点。
根据模型的不同,Pure Pursuit算法需要使用不同的控制公式,例如:

自行车模型:

在这里插入图片描述
如上图所示,点C为路径上的一个点(前视点/预瞄点),Pure Pursuit算法的目标则是控制B的角速度,使得A点可以经过C点。
假设我们以AC两点画一个圆弧,注意,由于要考虑到运动学约束,这段圆弧应当与直线AB相切,也就是角OAB=90度。同时我们知道对于圆弧,OA=OC,三角形AOC为等腰三角形。
∠ O A C = ∠ O C A \angle OAC = \angle OCA ∠OAC=∠OCA
同时有:
∠ O A C + ∠ C A B = π 2 \angle OAC +\angle CAB = \frac{\pi}{2} ∠OAC+∠CAB=2π​
即:
2 ∗ ( ∠ O A C + ∠ C A B ) = π 2*(\angle OAC +\angle CAB )= \pi 2∗(∠OAC+∠CAB)=π
于是可以得到:
∠ O A C + ∠ O C A + 2 ∗ ∠ C A B = π \angle OAC + \angle OCA + 2*\angle CAB = \pi ∠OAC+∠OCA

路径跟踪之Pure Pursuit控制算法 Pure Pursuit是一种几何跟踪控制算法,也被称为纯跟踪控制算法。该算法最早由R. Wallace在1985年提出,其思想是基于当前车辆的后轮中心位置(车辆质心),在参考路径上向(称为前视距离)的距离匹配一个预瞄点,假设车辆后轮中心可以按照一定的转弯半径????行驶至该预瞄点,然后根据前视距离、转弯半径????、车辆坐标系下预瞄点的朝向角????之间的几何关系来计算前轮转角。 如上图所示,在三角形OAC中,根据正弦定理可得: 根据车辆的运动学方程,有: 所以,前轮转角为: 车辆 阅读详情

相关推荐

横向控制 | Pure Persuit(纯跟踪)算法

横向控制 | Pure Persuit(纯跟踪)算法1. 算法简介2. 源码解析3. 效果演示 参考链接:https://zhuanlan.zhihu.com/p/48117381 Github链接:https://github.com/chanchanchan97/ROS 1. 算法简介 单车模型(Bicycle Model)实际上是对阿克曼转向几何的一个简化,使用单车模型需做如下假设: 不考虑车辆在Z轴方向的运动,只考虑XY水平面的运动; 左右侧车轮转角一致,这样可将左右侧轮胎合并为一个轮胎,以便于

Rome was not built in a day. 1万+

使用pure_persuit算法实现ROS小车路径跟踪

路径跟踪、pure_persuit算法、ROS机器人

Yangxiaoaijiejie的博客 1666

自动驾驶控制算(Pure Pursuit)--基础知识篇

根据上面等式可以得到:纯跟踪控制的效果取决于预瞄距离的选取,预瞄距离越长,前轮转角变化会越小,控制效果会越平滑,预瞄距离越短,控制效果会更精确,但也会带来一定的震荡。Pure Pursuit将车辆模型简化为自行车模型(这里默认左轮和右轮的旋转是一致的),通过调整前轮转角,使车子进行画弧运动,从而逼近预瞄点,来消除横向偏差的横向控制算法,算法本质上是一个P控制器,输入为横向位置误差,输出为前轮转角,该算法的的参考点为后轴中心点。又因为三角关系,可以求出下列的第一个等式,联合上面求出的等式。

qq_43469443的博客 802

用Python从零实现自动驾驶的“眼睛”:Pure Pursuit纯跟踪算法保姆级教程

本文详细介绍了如何使用Python从零实现自动驾驶中的Pure Pursuit纯跟踪算法,该算法作为自动驾驶系统的核心组件,能够高效完成轨迹跟踪任务。教程涵盖车辆运动学模型、轨迹生成、算法核心实现及仿真可视化,特别结合阿克曼转向模型进行深入解析,适合具备基础Python能力的开发者学习自动驾驶技术。

weixin_30781433的博客 329

保姆级教程:用Python从零实现自动驾驶的Pure Pursuit轨迹跟踪算法

本文提供了一份详细的Python教程,教你从零实现自动驾驶中的Pure Pursuit轨迹跟踪算法。通过构建车辆仿真环境、实现核心算法并进行参数调优,帮助开发者掌握轨迹跟踪技术,适用于自动驾驶和机器人导航等场景。

weixin_30512089的博客 470

【行为决策模块项目实战】解耦控制--多控制器管理与切换的方法(附C++代码)

[请添加图片描述](https://img-blog.csdnimg.cn/c11300d9e4fe421e9070f474a468d1db.jpeg)本文先对多控制器管理与切换的方法做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容VERTICAL_VEL, //垂直速度PID控制器VERTICAL_POS, //垂直位置PID控制器HORIZONTAL, //水平速度PID控制器YAW, //航向角yaw位置逻辑控制器。

qq_35635374的博客 1214

【导航项目实战】autoware巡航、避障、视觉目标检测部署步骤

无人车&无人机导航合集本文先对**【autoware巡航、避障、视觉目标检测】步骤简单记录**做个简单的介绍,具体内容后续再更,其他模块可以参考去我其他文章提示:以下是本篇文章正文内容。

qq_35635374的博客 449

AGV小车运动计算

AGV两轮小车动力学方程,使用与小车建模与控制仿真。

告别手动干预:深入浅出LPDDR5的Background ZQ校准与DVFSQ切换避坑指南

本文深入解析LPDDR5的Background ZQ校准与DVFSQ切换技术,帮助工程师实现DRAM阻抗校准的自动化管理。通过详细配置指南和实战案例,揭示如何避免动态电压调节下的模式切换陷阱,提升信号完整性和系统能效。特别适合嵌入式系统和移动终端开发者参考。

weixin_30329623的博客 457

深入解析LinuxCNC源码:从界面开发到硬件交互

本文深入解析LinuxCNC开源数控系统的源码架构与二次开发实践。详细介绍了从GTK+界面定制、Python脚本绑定,到硬件抽象层(HAL)配置与核心运动控制模块的完整开发流程。通过实战案例,帮助开发者掌握如何基于LinuxCNC源码进行界面开发和硬件交互定制,实现个性化数控系统。

weixin_29164843的博客 549

大众点评爬虫实战:如何用Python绕过反爬机制获取评论数据(附完整代码)

本文深入探讨了2024年使用Python进行大众点评数据采集的实战策略。文章详细解析了现代反爬机制的核心逻辑,并提供了从构建拟人化请求会话、应对动态内容与接口加密,到工程化实践(代理调度、状态持久化)的完整解决方案与代码示例,旨在帮助数据分析师稳健获取评论数据,用于后续的文本挖掘与商业洞察。

weixin_29084111的博客 1924

Dify社区版多工作空间功能解锁:源码修改与多租户架构解析

多租户架构是现代SaaS平台实现数据隔离与资源管理的核心技术,其核心原理是通过租户模型将用户、应用和数据在逻辑上隔离。在AI应用开发平台中,这种架构能有效支持多团队、多项目并行开发,确保不同业务线的数据安全与独立迭代。Dify作为开源AI应用构建平台,其底层已设计完善的多租户模型,但社区版默认限制了单用户单工作空间。本文通过精准修改两处关键代码——账户初始化逻辑与系统功能开关,释放了平台固有的多工作空间管理能力。该方案无需改动数据库结构,直接利用现有RBAC权限体系,实现了类似企业版的**多租户隔离**体验

weixin_27059669的博客 1076

基于Simulink的固态变压器(SST)多级协同控制

本文基于Simulink平台,详细介绍了固态变压器(SST)多级协同控制的建模与仿真方法。针对SST三级架构(AC-DC、DC-DC、DC-AC)存在的级间耦合问题,提出了纵向解耦与横向联动的协同控制策略。通过搭建10kV/400V级联型SST系统模型,实现了输入电压波动±20%或负载0-100%跳变时直流母线电压波动小于2%的控制目标。文章详细讲解了Simulink建模步骤、控制算法推导及工程部署建议,包括功率前馈控制、虚拟惯性算法等关键技术。仿真结果表明,该协同控制方案能有效抑制负载突变时的电压波动,为

MHD0815的博客 220

【Docker】完美解决拉取镜像超时报错:ERROR: Get https://registry-1.docker.io/v2/

因为我们下载的镜像是外网的镜像资源,所以下载的速度会非常的慢,甚至大概率下载时会报错,所以需要我们配置一个国内的服务器镜像地址,国内服务器镜像地址有很多,这里咱们就说一下阿里镜像加速器的配置方法。

liu_chen_yang的博客 12万+

华为OD机试真题 Java&Go 实现【优雅子数组】【100%通过率】【2022.11 Q4 新题】

如果一个数组中出现次数最多的元素出现大于等于K次,被称为K -优雅数组,k也可以被称为优雅阈值。例如,数组1,2,3,1、2,3,1,它是一个3-优雅数组,因为元素1出现次数大于等于3次,数组1,2,3,1,2就不是一个3-优雅数组,因为其中出现次数最多的元素是1和2,只出现了2次。给定一个数组A和k,请求出A有多少子数组是k-优雅子数组。

MISAYAONE的博客 1万+

【计算机视觉 | MMDetection】关于mmdetection如何计算参数量、计算量和速度FPS

【计算机视觉 | MMDetection】关于mmdetection如何计算参数量、计算量和速度FPS

wzk4869的博客 3024

温度PID控制PLC程序

温度PID稳定控制程序,适用于欧姆龙PLC,对其他PLC也具有很大参考价值

Devexpress16.2.6破解工具

Devexpress16.2.6破解工具Devexpress16.2.6破解工具Devexpress16.2.6破解工具Devexpress16.2.6破解工具

NTscan扫描工具

ntscan是一个扫描器,可以扫描没有密码和弱密码的共享,先到配置文件中填写猜测的用户名和密码,扫描过程中右侧出现的是扫描日志。

SAP B1中文培訓教材_SDK

公司内部培训资料,对开发工具 ,DIAPI, UIAPI,Add-ON有详细解说

上一篇: 贝塞尔曲线基础
下一篇: Stanley算法原理
一叶执念
博客等级 码龄7年 1706粉丝 165原创
评论
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付:10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

一叶执念

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值
⌂ 换网址