完善资料让更多小伙伴认识你,还能领取20积分哦, 立即完善>
扫一扫,分享给好友
|
|
相关推荐
1个回答
|
|
纯追踪算法
自行车模型 在了解纯追踪算法之前,需要先了解车辆模型,一个简化的自行车模型。 运动学自行车模型和动力学自行车模型 轨迹追踪 目前主流的轨迹跟踪方法有两类,基于几何的追踪方法和基于模型预测的方法,纯追踪就是基于几何追踪的方法。 下图是一个运动学自行车模型: 它是对阿卡曼转向几何的简化,将车辆四轮模型简化为两轮模型,并且假定车辆只在平面上行驶,那么前轮转角δ、轴距和转向半径将遵循以下关系: 其中δ是前轮的转向角,L为轴距,R为当前转角下的转向半径。 从自行车模型出发,纯追踪算法以车后轴为切点、车辆纵向车身为切线,通过控制前轮转向角,使车辆可以沿着一条经过目标路经点的圆弧行驶,如下图所示: 图中 (gx, gy)是我们下一个要追踪的路点,它位于我们已经规划好的全局路径上,现在需要控制车辆是的车辆的后轴经过该路点,表示车辆当前位置(即后轴位置)到目标路点的距离, 表示目前车身姿态和目标路点的夹角,那么更具正弦定理我们可以推导出如下转换式: 上式也可以表示为: 其中 k 是计算出来的圆弧的曲率,那么前轮的转角 δ 的表达式为: 结合以上两式,我们可以得出纯追踪算法控制量的的最终表达式: 这里我们把时间考虑进来,在知道t时刻车身和目标路点的夹角 α(t) 和距离目标路点的前视距离 ld 的情况下,由于车辆轴距 L固定,我们可以利用上式估计出应该作出的前轮转角 δ,为了更好的理解纯追踪控制器的原理,我们定义一个新的量:el—— 车辆当前姿态和目标路点在横向上的误差,由此可得夹角正弦: 圆弧的弧度就可重写为: 考虑到本质是横向上的CTE,由上式可知纯追踪控制器其实是一个横向转角的P控制器,其P系数为2/ld2,这个P控制器受到参数ld(即前视距离)的影响很大,如何调整前视距离变成纯追踪算法的关键,通常来说,ld被认为是车速的函数,在不同的车速下需要选择不同的前视距离。 一种最常见的调整前视距离的方法就是将前视距离表示成车辆纵向速度的线形函数,即ld=kVx,那么前轮的转角公式就变成了: 那么纯追踪控制器的调整就变成了调整系数k,通常来说,会使用最大,最小前视距离来约束前视距离,越大的前视距离意味着轨迹的追踪越平滑,小的前视距离会使得追踪更加精确(当然也会带来控制的震荡),下面我们使用Python实现一个简单的纯追踪控制器。 本文使用Matlab和Simulink构建了一个简单的纯追踪模型并进行了仿真,整体流程框图如下: 主要分为四部分,第一部分是一个自定义的最邻近路径点搜索函数,中间是控制部分,主要计算车辆横向误差 e l e_l el和控制量转向角δ,第三部分是车辆模型,使用的Simulink自带的三自由度车辆模型,最后是一个画图的函数,控制部分内部流程框图如下: 最后追踪的效果如下: github地址:Pure-Pursuit-Control 参考: http://blog.csdn.net/adamshan/article/details/78696874 https://blog.csdn.net/AdamShan/article/details/80555174?spm=1001.2014.3001.5501 《无人驾驶原理与实践》 申泽邦 |
|
|
|
只有小组成员才能发言,加入小组>>
调试STM32H750的FMC总线读写PSRAM遇到的问题求解?
1617 浏览 1 评论
X-NUCLEO-IHM08M1板文档中输出电流为15Arms,15Arms是怎么得出来的呢?
1543 浏览 1 评论
977 浏览 2 评论
STM32F030F4 HSI时钟温度测试过不去是怎么回事?
683 浏览 2 评论
ST25R3916能否对ISO15693的标签芯片进行分区域写密码?
1595 浏览 2 评论
1863浏览 9评论
STM32仿真器是选择ST-LINK还是选择J-LINK?各有什么优势啊?
644浏览 4评论
STM32F0_TIM2输出pwm2后OLED变暗或者系统重启是怎么回事?
515浏览 3评论
531浏览 3评论
stm32cubemx生成mdk-arm v4项目文件无法打开是什么原因导致的?
504浏览 3评论
小黑屋| 手机版| Archiver| 电子发烧友 ( 湘ICP备2023018690号 )
GMT+8, 2024-11-22 06:39 , Processed in 0.649073 second(s), Total 47, Slave 40 queries .
Powered by 电子发烧友网
© 2015 bbs.elecfans.com
关注我们的微信
下载发烧友APP
电子发烧友观察
版权所有 © 湖南华秋数字科技有限公司
电子发烧友 (电路图) 湘公网安备 43011202000918 号 电信与信息服务业务经营许可证:合字B2-20210191 工商网监 湘ICP备2023018690号