自动驾驶仿真：基于Carsim开发的加速度请求模型

文章目录

  • 前言
  • 一、加速度输出变量问题澄清
  • 二、配置Carsim动力学模型
  • 三、配置Carsim驾驶员模型
  • 四、添加VS Command代码
  • 五、Run Control联合仿真
  • 六、加速度模型效果验证

前言

1、自动驾驶行业中，算法端对于纵向控制的功能预留接口基本都是加速度，我们需要给控制器仿真加速度的信号，控制器才会实现对纵向功能的控制。

2、Carsim或者其他动力学软件，主要提供者节气门开度和主缸压力进行控制。我们在进行联合仿真时，往往都要通过PID的方式将请求加速度转换成对应的节气门开度与主缸压力传给动力学软件进行闭环控制。

3、这里提供一个使用Carsim的VS Command方法定义一个加速度输入变量，修改车辆的动力系统模型，然后通过PID调节变矩器扭矩和主缸压力输出加速度来实现这个响应接近完美的加速度模型。

一、加速度输出变量问题澄清

问题澄清：改变动力学模型后Carsim Output接口输出的加速度值异常
1、正常情况下Carsim的加速度输出变量AX、AX_SM是能够正常输出加速度值，但是经过VS Command以及动力学模型修改之后Carsim Output接口加速度输变量输出值会比原值小10倍。因此需要在VS Command中定义新的加速度输出变量来解决输出值小10倍的问题。

2、自证Carsim Output接口输出加速度变量比原值小10倍。首先Carsim接口和VS Command中添加加速度输出变量，RsponAx是在VS Command定义的加速度输出变量，本质是在VS Command获取AX的值。

在这里插入图片描述
在这里插入图片描述

3、和Labview联合仿真：通过观察请求加速度（蓝色）、正确加速度RsponAx（红色曲线）和错误加速度AX（绿色曲线）就可以看出Rspon在VS Command拿的AX值是正常的，而直接从Carsim输出接口拿的AX比原值小10倍是不正确的。

在这里插入图片描述

4、再分析此时的速度变化情况，此时的速度变化是基于0.2g的正确加速度进行变化的，因此推断Carsim输出接口拿的AX 0.02g是错误的。
X轴300-600之间，这3秒钟速度变化大概为21kph（图表），由于V=at = 0.2*9.8*3 =5.88m/s，转换成km/h为21km/h左右。因此推断0.2g的正确加速度。

在这里插入图片描述

二、配置Carsim动力学模型

1、配置车辆模型

在这里插入图片描述

2、这里复制了Carsim自带例程C-Class, Hatchback。

在这里插入图片描述

3、修改车辆的动力系统模型，随便复制一个例程并进入修改内容。

在这里插入图片描述

4、选择外部发动力模型和外部变矩器，从模型上看只要调整变矩器扭矩IMP_M_OUT_TC即可实现纵向加速控制，减速控制一般都是通过主缸压力PBK_CON进行控制的。

在这里插入图片描述

5、修改挡位参数，改成1个前进挡位

在这里插入图片描述

改成1个前进挡位，否则速度加不上去

在这里插入图片描述

三、配置Carsim驾驶员模型

1、老规矩随便复制一个例程

在这里插入图片描述

2、驾驶员模型配置
1）配置概览

在这里插入图片描述

2）节气门开度加初始速度控制，但是由于我们修改了模型我们加速不控制THROTTLE_ENGINE，我们直接在VS Command控制变矩器扭矩IMP_M_OUT_TC。

在这里插入图片描述

3）初始刹车主缸压力为0MP，在VS Command控制变量为PBK_CON。

在这里插入图片描述

4）开闭环的档位控制（-1:倒挡 0:空挡 1-6:前进挡），在VS Command控制变量为MODE_TRANS。

在这里插入图片描述

5）最后配置一个Run就行，Forerer或者时间都行。

在这里插入图片描述

四、添加VS Command代码

重头戏：VS Command，相当于Carsim开放的脚本编写命令行，直接上脚本，我就不对脚本的每一句内容进行解析了，有兴趣的结合官方文档VS Command分析。

1、配置Carsim VS Command
在这里插入图片描述

2、将下面脚本复制进VS Command中去

在这里插入图片描述

!Define vehicle forward related variables
define_variable CumErr_TC 0
define_variable CumErr_BK 0
define_variable CurErr 0
define_variable Torque_TC 0
define_variable PCON_BK 0

!Define vehicle reverse related variables
define_variable RCumErr_TC 0
define_variable RCumErr_BK 0
define_variable RCurErr 0
define_variable RTorque_TC 0
define_variable RPCON_BK 0

!Define driver Behavior variables
define_variable ForwardFlag 0
define_variable ReverseFlag 0

!Add Brake master cylinder pressure
!Add shaft torque of torque converter
IMP_PCON_BK VS_add 0
IMP_M_OUT_TC VS_add 0

!Define PID related parameter
define_parameter P_TC 0.5
define_parameter I_TC 0.2
define_parameter D_TC 0.0
define_parameter P_BK 0.5
define_parameter I_BK 0.005
define_parameter D_BK 0.000

!Define Operating cycle
define_parameter DeltaT 0.001

!Define Input/Output variables
define_import IMP_TargetAX 0
define_import IMP_TargetBk 0
define_import IMP_ConMode 0
define_output RsponAx

!Select Froward or Reverse
EQ_IN ForwardFlag = GE(IMP_TargetAX,0)
EQ_IN ReverseFlag = LE(IMP_TargetAX,0)

!Caiculate Current Error and Cumulative error
EQ_OUT CurErr= IMP_TargetAX - AX
EQ_OUT RCurErr= AX -  IMP_TargetAX
EQ_OUT CumErr_TC = IF_GT_0_THEN(ForwardFlag,CumErr_TC+CurErr,0)
EQ_OUT RCumErr_TC = IF_GT_0_THEN(ReverseFlag,RCumErr_TC+RCurErr,0)
EQ_OUT CumErr_BK = IF_NOT_0_THEN(ForwardFlag,0,CumErr_BK+CurErr)
EQ_OUT RCumErr_BK = IF_NOT_0_THEN(ReverseFlag,0,RCumErr_BK+CurErr)

!Forward PID(Torque)
EQ_IN Torque_TC = P_TC*CurErr+I_TC*CumErr_TC+D_TC*CurErr/DeltaT
EQ_IN Torque_TC = IF_GT_0_THEN(Torque_TC, Torque_TC,0)
EQ_IN Torque_TC = IF_GT_0_THEN(ForwardFlag,Torque_TC,0)

!Reverse PID(Torque) 
EQ_IN RTorque_TC = P_TC*RCurErr+I_TC*RCumErr_TC+D_TC*RCurErr/DeltaT
EQ_IN RTorque_TC = IF_GT_0_THEN(RTorque_TC, RTorque_TC,0)
EQ_IN RTorque_TC = IF_GT_0_THEN(ReverseFlag,RTorque_TC,0)

!Forward or backward depending on the transmission mode
EQ_IN IMP_M_OUT_TC = IF_GT_0_THEN(GE(ModeTran, 0), Torque_TC, RTorque_TC)
EQ_IN IMP_M_OUT_TC = IF_GT_0_THEN(EQ(ModeTran, 0), 0 , IMP_M_OUT_TC)
EQ_IN IMP_M_OUT_TC = IF_GT_0_THEN(IMP_ConMode, 0 , IMP_M_OUT_TC)

!Forward PID(Brake)
EQ_IN PCON_BK = -(P_BK*CurErr+I_BK*CumErr_BK+D_BK*CurErr/DeltaT)
EQ_IN PCON_BK = IF_GT_0_THEN(PCON_BK-15, 15, PCON_BK)
EQ_IN PCON_BK = IF_GT_0_THEN(PCON_BK, PCON_BK,0)
EQ_IN PCON_BK = IF_NOT_0_THEN(ForwardFlag,0,PCON_BK)*1e6
EQ_IN PCON_BK = IF_NOT_0_THEN(IMP_TargetBk,IMP_TargetBk,PCON_BK)

!Reverse PID(Brake) 
EQ_IN RPCON_BK = P_BK*CurErr+I_BK*CumErr_BK + D_BK*CurErr/DeltaT
EQ_IN RPCON_BK = IF_GT_0_THEN(RPCON_BK-15, 15, RPCON_BK)
EQ_IN RPCON_BK = IF_NOT_0_THEN(IMP_TargetBk, IMP_TargetBk,RPCON_BK)
EQ_IN RPCON_BK = IF_GT_0_THEN(GE(ModeTran,0), RPCON_BK,0)
EQ_IN RPCON_BK = IF_GT_0_THEN(RPCON_BK, RPCON_BK,0)*1e6

!Acceleration braking or direct braking depending on the mode
EQ_IN IMP_PCON_BK = IF_GT_0_THEN(GE(ModeTran, 0), PCON_BK, RPCON_BK)
EQ_IN IMP_PCON_BK = IF_GT_0_THEN(IMP_ConMode, IMP_TargetBk, IMP_PCON_BK)

!if ModeTran=0，Clear accumulated error
EQ_OUT CumErr_TC = IF_GT_0_THEN(EQ(ModeTran, 0),0,CumErr_TC)
EQ_OUT RCumErr_TC = IF_GT_0_THEN(EQ(ModeTran, 0),0,RCumErr_TC)
EQ_OUT CumErr_BK = IF_GT_0_THEN(EQ(ModeTran, 0),0,CumErr_BK)
EQ_OUT RCumErr_BK = IF_GT_0_THEN(EQ(ModeTran, 0),0,RCumErr_BK)

EQ_OUT RsponAx= AX

我在脚本中定义了新的接口变量：

!Define Input/Output variables
define_import IMP_TargetAX 0     !IMP_TargetAX是外部请求的加速度接口。
define_import IMP_TargetBk 0     !IMP_TargetBk是外部请求的主缸压力，一般通过给减速度就可以控制，这里开放了手动减速 的方法。
define_import IMP_ConMode 0      !IMP_ConMode自动模式0或者手动模式1，自动模式通过加速度控制减速，手动模式发送IMP_TargetBk值进行减速，默认自动模式。
define_output RsponAx 0          !RsponAx定义新的加速度输出接口，Carsim端的加速度接口AX比原值小10倍，因此使用RsponAx作为加速度响应。

五、Run Control联合仿真

1、这里使用的Labiew，大家可以用Simulink联合仿真。

在这里插入图片描述

2、添加输入变量

在这里插入图片描述

3、添加输出变量

在这里插入图片描述

4、Send to Labview

在这里插入图片描述

六、加速度模型效果验证

1、层叠曲线显示所有变量

在这里插入图片描述

2、前进挡：请求加速度与响应加速度曲线（挡位给1，加速度值给正值）

在这里插入图片描述

3、后退挡：请求加速度与响应加速度曲线（挡位给-1，加速度值给负值）

在这里插入图片描述

综上，完成加速度模型搭建，模型可能还有点小缺陷，大神们可以指导一下，如有问题及时沟通。

本文来自互联网用户投稿，该文观点仅代表作者本人，不代表本站立场。本站仅提供信息存储空间服务，不拥有所有权，不承担相关法律责任。如若转载，请注明出处：http://www.mfbz.cn/a/82168.html

如若内容造成侵权/违法违规/事实不符，请联系我们进行投诉反馈qq邮箱809451989@qq.com，一经查实，立即删除！

相关文章

git环境超详细配置说明

git环境超详细配置说明

一，简介 在git工具安装完成之后，需要设置一下常用的配置，如邮箱，缩写，以及git commit模板等等。本文就来详细介绍些各个配置如何操作，供参考。 二，配置步骤 2.1 查看当前git的配置 git conf…
阅读更多...
解决ios隔空播放音频到macos没有声音的问题

解决ios隔空播放音频到macos没有声音的问题

解决ios隔空播放音频到macos没有声音的问题 一、检查隔空播放支持设备和系统要求二、打开隔空播放接收器三、重置MAC控制中心进程END 一、检查隔空播放支持设备和系统要求 Mac、iPhone、iPad 和 Apple Watch 上“连续互通”的系统要求 二、打开隔空播放接收器 ps;我设备是同一…
阅读更多...
基于web的停车场收费管理系统/基于springboot的停车场管理系统

基于web的停车场收费管理系统/基于springboot的停车场管理系统

摘 要 随着汽车工业的迅猛发展，我国汽车拥有量急剧增加。停车场作为交通设施的组成部分,随着交通运输的繁忙和不断发展，人们对其管理的要求也不断提高，都希望管理能够达到方便、快捷以及安全的效果。停车场的规模各不相同,对其进行管理的模…
阅读更多...
剪枝基础与实战(3): 模型剪枝和稀疏化训练流程

剪枝基础与实战(3): 模型剪枝和稀疏化训练流程

Model Pruning 相关论文：Learning Efficient Convolutional Networks through Network Slimming (ICCV 2017) 考虑一个问题，深度学习模型里面的卷积层出来之后的特征有非常多，这里面会不会存在一些没有价值的特征及其相关的连接？又如何去判断一个特征及其连接是否有价值？ …
阅读更多...
redis实战-缓存数据解决缓存与数据库数据一致性

redis实战-缓存数据解决缓存与数据库数据一致性

缓存的定义 缓存(Cache),就是数据交换的缓冲区,俗称的缓存就是缓冲区内的数据,一般从数据库中获取,存储于本地代码。防止过高的数据访问猛冲系统,导致其操作线程无法及时处理信息而瘫痪，这在实际开发中对企业讲,对产品口碑,用户评价都是致命的;所以企业非常重视缓存…
阅读更多...
【汇编语言】使用DS和[address]实现字的传送

【汇编语言】使用DS和[address]实现字的传送

文章目录 要解决的问题：CPU从内存单元中读取数据字的传送 要解决的问题：CPU从内存单元中读取数据 1、要求：CPU要读取一个内存单元时，必须先给出这个内存单元的地址； 2、原理：8086设备中，内存地…
阅读更多...
LeetCode--HOT100题（35）

LeetCode--HOT100题（35）

目录 题目描述：23. 合并 K 个升序链表（困难）题目接口解题思路1代码解题思路2代码 PS: 题目描述：23. 合并 K 个升序链表（困难） 给你一个链表数组，每个链表都已经按升序排列。 请你将所有链表合…
阅读更多...
git压缩/合并多次commit提交为1次commit提交

git压缩/合并多次commit提交为1次commit提交

git压缩/合并N次commit提交为1次commit提交 假设有最近3次提交： commit_id1 commit_id2 commit_id3目标是把以上3次commit合并成1个commit，注意，最新的commit提交在最上面。 在git bash里面的操作步骤： （1&#xff0…
阅读更多...
【周末闲谈】关于“数据库”你又知道多少？

【周末闲谈】关于“数据库”你又知道多少？

个人主页：【😊个人主页】 系列专栏：【❤️周末闲谈】 系列目录 ✨第一周 二进制VS三进制 ✨第二周 文心一言，模仿还是超越？ ✨第二周 畅想AR 文章目录 系列目录前言数据库数据库的五大特点数据库介绍数据库管理系统&a…
阅读更多...
Oracle故障案例之-19C时区补丁DSTV38更新

Oracle故障案例之-19C时区补丁DSTV38更新

📢📢📢📣📣📣 哈喽！大家好，我是【IT邦德】，江湖人称jeames007，10余年DBA工作经验 一位上进心十足的【大数据领域博主】！😜&#x1f61…
阅读更多...
《TCP IP网络编程》第二十四章

《TCP IP网络编程》第二十四章

第 24 章 制作 HTTP 服务器端 24.1 HTTP 概要 本章将编写 HTTP（HyperText Transfer Protocol，超文本传输协议）服务器端，即 Web 服务器端。 理解 Web 服务器端： web服务器端就是要基于 HTTP 协议，将网页对…
阅读更多...
2023国赛数学建模E题思路模型代码 高教社杯

2023国赛数学建模E题思路模型代码 高教社杯

本次比赛我们将会全程更新思路模型及代码，大家查看文末名片获取 之前国赛相关的资料和助攻可以查看 2022数学建模国赛C题思路分析_2022国赛c题matlab_UST数模社_的博客-CSDN博客 2022国赛数学建模A题B题C题D题资料思路汇总 高教社杯_2022国赛c题matlab_UST数模社…
阅读更多...
RK3588平台开发系列讲解（AI 篇）RKNN-Toolkit2 API 介绍

RK3588平台开发系列讲解（AI 篇）RKNN-Toolkit2 API 介绍

文章目录 一、RKNN 初始化及对象释放二、RKNN 模型配置沉淀、分享、成长，让自己和他人都能有所收获！😄 📢本篇章主要讲解 RKNN-Toolkit2 API 详细说明。 一、RKNN 初始化及对象释放 在使用 RKNN Toolkit2 的所有 API 接口时，都需要先调用 RKNN()方法初始化 RKNN 对象，…
阅读更多...
图数据库_Neo4j和SpringBoot整合使用_实战创建明星关系图谱---Neo4j图数据库工作笔记0010

图数据库_Neo4j和SpringBoot整合使用_实战创建明星关系图谱---Neo4j图数据库工作笔记0010

然后我们再来看一下这个明星关系图谱 可以看到这里 这个是原来的startRelation 我们可以写CQL去查询对应的关系 可以看到,首先查询出来以后,然后就可以去创建 我们可以把写的创建明星关系的CQL,拿到 springboot中去执行 可以看到,这里我们先写一个StarRelationRepository,然…
阅读更多...
工作6年了日期时间格式化还在写YYYY疯狂给队友埋雷

工作6年了日期时间格式化还在写YYYY疯狂给队友埋雷

前言 哈喽小伙伴们好久不见，今天来个有意思的雷，看你有没有埋过。 正文 不多说废话，公司最近来了个外地回来的小伙伴，在广州工作过6年，也是一名挺有经验的开发。 他提交的代码被小组长发现有问题，给打回了&…
阅读更多...
【C语言练习】数组OJ题

【C语言练习】数组OJ题

目录 一.消失的数字思路1：思路2： 二.移除元素三.轮转数组四.删除有序数组中的重复项五.合并两个有序数组 一.消失的数字 题目： 思路1： 数组是从0加到N，所以把0到N的数加起来减去数组中的值，结果就是消失…
阅读更多...
文心一言最新重磅发布！

文心一言最新重磅发布！

8月16日，由深度学习技术及应用国家工程研究中心主办的WAVE SUMMIT深度学习开发者大会2023举办。百度首席技术官、深度学习技术及应用国家工程研究中心主任王海峰以《大语言模型为通用人工智能带来曙光》为题，阐述了大语言模型具备理解、生成、逻辑、记忆…
阅读更多...
【学习日记】【FreeRTOS】时间片的实现

【学习日记】【FreeRTOS】时间片的实现

前言 本文以野火的教程和代码为基础，对 FreeRTOS 中时间片的概念作了解释，并且给出了实现方式，同时发现并解决了野火教程代码中的 bug。 一、时间片是什么 在前面的文章中，我们已经知道任务根据不同的优先级被放入就绪列表中不…
阅读更多...
Linux 安全技术和防火墙

Linux 安全技术和防火墙

目录 1 安全技术 2 防火墙 2.1 防火墙的分类 2.1.1 包过滤防火墙 2.1.2 应用层防火墙 3 Linux 防火墙的基本认识 3.1 iptables & netfilter 3.2 四表五链 4 iptables 4.2 数据包的常见控制类型 4.3 实际操作 4.3.1 加新的防火墙规则 4.3.2 查看规则表 4.3.…
阅读更多...
Qt实现简单的漫游器

Qt实现简单的漫游器

文章目录 Qt的OpenGL窗口GLSL的实现摄像机类的实现简单的漫游器 Qt的OpenGL窗口 Qt主要是使用QOpenGLWidget来实现opengl的功能。  QOpenGLWidget 提供了三个便捷的虚函数，可以重载，用来重新实现典型的OpenGL任务： paintGL：渲染…
阅读更多...
最新文章

Copyright @ 2022~2023

友情链接： 我的编程经验分享 一条长河网 尧图网站开发 尧图建网站