基于MPC的自动驾驶泊车控制

2024-04-11 16:20
文章标签 自动 控制 驾驶 mpc 泊车

本文主要是介绍基于MPC的自动驾驶泊车控制,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

基于MPC的自动驾驶泊车控制

H. Ye, H. Jiang, S. Ma, B. Tang, and L. Wahab, “Linear model predictive control of automatic parking path tracking with soft constraints,” International Journal of Advanced Robotic Systems, vol. 16, no. 3, p.

image

附赠自动驾驶学习资料和量产经验:链接

核心思想就是先进行几何的规划,得到路径,然后再通过MPC对路径进行traking 用的方法都是常规的方法,用了车辆的运动学。没有什么特别之处。

车辆建模这部分,由于是Parking场景,速度很低,轮子的
摩擦力没有饱和,可以利用了车辆的运动学模型,其实就是阿卡曼约束,用中文来解释一下,就是车辆在运动的时候,可以看成车的每一个轮子都在绕着一个圆心运动。
那么很容易得到,后轴中心的速度就是和车架的方向一致。因此就可以很容易得到运动学模型。
至于最后一行,车辆heading的基本上和车辆的速度以及车辆前轮转角成正比。这个也可以从几何学的关系式看到。

image

image

基于几何的规划方法,下面的这个图中,重要的点有两个,一个是C点,这个点是停车位的某个角点,可以根据几何关系求出来弧线OC对应的曲率半径R1,同时也可以知道C点处的切线角度。其实CB是直线。这两段线用下面的公式描述:

image

而曲线AB 用下面这个公式来表达

image

论文中并没有描述这个线型的特征,或者优势,我觉的这点很成问题,也没说明这个线的来源。

MPC控制

目前通过规划,我们拿到了期望的路径(path) 然后作者构建了车辆的离散化的状态更新方程。
需要注意的是,我们在前面通过Ackerman公式得到了车辆的运动学模型,它是连续非线性的方程。这里需要做线性化和离散化。后面的部分都是常规操作,比如在参考点处展开,离散形式等等。

image

image

这里做了一个小的改变,把车辆的状态扩张了一下,多了一个维度,放进去的是上一帧的控制量。这个改变是为了把控制输入写成增量的形式。

image

最后,可以预测未来n个time steps 的控制输出。

image

注意,这里Y(k)是k个predict horizons的结果,而\delta U 不一定是k个,可能小于K
有了这个Y(k) 之后,带入到下面的目标函数里面:

image

整理一下,写成变量 的二次型的形式(如下面的公式,这个推导有点麻烦,但是都是常规操作,放到论文的appendix里面就好,居然放到正文里面。。。。),就可以丢到优化器里面了。

image

仿真和实验

仿真和实验部分写了一大堆的结果分析,但是对实验条件的描述不够,比如,1. 在文章中,并没有找到关于参考速度是如何得到的,2,没有看到仿真和实验的离散化的步长,这个步长对结果其实影响还是比较大的。
还有PID到底是如何实现的?因为很多时候车辆采用PID算法,会有不同的结构形式,这个影响也会很大,作者需要在这里描述清楚。

这篇关于基于MPC的自动驾驶泊车控制的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/894577

相关文章

SpringBoot中封装Cors自动配置方式

《SpringBoot中封装Cors自动配置方式》:本文主要介绍SpringBoot中封装Cors自动配置方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录SpringBoot封装Cors自动配置背景实现步骤1. 创建 GlobalCorsProperties

idea中创建新类时自动添加注释的实现

《idea中创建新类时自动添加注释的实现》在每次使用idea创建一个新类时,过了一段时间发现看不懂这个类是用来干嘛的,为了解决这个问题,我们可以设置在创建一个新类时自动添加注释,帮助我们理解这个类的用... 目录前言:详细操作:步骤一:点击上方的 文件(File),点击&nbmyHIgsp;设置(Setti

Python异步编程中asyncio.gather的并发控制详解

《Python异步编程中asyncio.gather的并发控制详解》在Python异步编程生态中,asyncio.gather是并发任务调度的核心工具,本文将通过实际场景和代码示例,展示如何结合信号量... 目录一、asyncio.gather的原始行为解析二、信号量控制法:给并发装上"节流阀"三、进阶控制

使用DrissionPage控制360浏览器的完美解决方案

《使用DrissionPage控制360浏览器的完美解决方案》在网页自动化领域,经常遇到需要保持登录状态、保留Cookie等场景,今天要分享的方案可以完美解决这个问题:使用DrissionPage直接... 目录完整代码引言为什么要使用已有用户数据?核心代码实现1. 导入必要模块2. 关键配置(重点!)3.

一文详解SQL Server如何跟踪自动统计信息更新

《一文详解SQLServer如何跟踪自动统计信息更新》SQLServer数据库中,我们都清楚统计信息对于优化器来说非常重要,所以本文就来和大家简单聊一聊SQLServer如何跟踪自动统计信息更新吧... SQL Server数据库中,我们都清楚统计信息对于优化器来说非常重要。一般情况下,我们会开启"自动更新

SpringSecurity 认证、注销、权限控制功能(注销、记住密码、自定义登入页)

《SpringSecurity认证、注销、权限控制功能(注销、记住密码、自定义登入页)》SpringSecurity是一个强大的Java框架,用于保护应用程序的安全性,它提供了一套全面的安全解决方案... 目录简介认识Spring Security“认证”(Authentication)“授权” (Auth

python之流程控制语句match-case详解

《python之流程控制语句match-case详解》:本文主要介绍python之流程控制语句match-case使用,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐... 目录match-case 语法详解与实战一、基础值匹配(类似 switch-case)二、数据结构解构匹

Flask 验证码自动生成的实现示例

《Flask验证码自动生成的实现示例》本文主要介绍了Flask验证码自动生成的实现示例,文中通过示例代码介绍的非常详细,对大家的学习或者工作具有一定的参考学习价值,需要的朋友们下面随着小编来一起学习... 目录生成图片以及结果处理验证码蓝图html页面展示想必验证码大家都有所了解,但是可以自己定义图片验证码

Python Excel实现自动添加编号

《PythonExcel实现自动添加编号》这篇文章主要为大家详细介绍了如何使用Python在Excel中实现自动添加编号效果,文中的示例代码讲解详细,感兴趣的小伙伴可以跟随小编一起学习一下... 目录1、背景介绍2、库的安装3、核心代码4、完整代码1、背景介绍简单的说,就是在Excel中有一列h=会有重复

Spring Security注解方式权限控制过程

《SpringSecurity注解方式权限控制过程》:本文主要介绍SpringSecurity注解方式权限控制过程,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录一、摘要二、实现步骤2.1 在配置类中添加权限注解的支持2.2 创建Controller类2.3 Us