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

news2024/9/20 18:44:43

文章目录

  • 前言
  • 一、加速度输出变量问题澄清
  • 二、配置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.coloradmin.cn/o/902715.html

如若内容造成侵权/违法违规/事实不符，请联系多彩编程网进行投诉反馈，一经查实，立即删除！

相关文章

【LeetCode75】第三十四题 叶子相似的树

【LeetCode75】第三十四题 叶子相似的树

目录 题目： 示例： 分析： 代码： 题目： 示例： 分析： 给我们两棵二叉树，让我们判断这两棵二叉树的从左到右的叶子节点组成的叶子序列是否一致，即从左到右的叶子节点的数…
阅读更多...
python爬虫实战零基础(2)——网页图片

python爬虫实战零基础(2)——网页图片

网页图片的批量爬取保存 分析思路预备知识xpath用法response.text和 response.content两者的区别 代码实战请求网页内容批量图片保存 分析思路 还是基于request和xpath的爬虫代码 定位目标网址（里面图片还是很好看的 https://pic.netbian.com/4kdongman/index.html&…
阅读更多...
漏洞指北-VulFocus靶场专栏-入门

漏洞指北-VulFocus靶场专栏-入门

漏洞指北-VulFocus靶场01-入门 VulFocus靶场前置条件：入门001 命令执行漏洞step1： 输入默认index的提示step2： 入门002 目录浏览漏洞step1：进入默认页面，找到tmp目录step2 进入tmp目录获取flag文件 VulFocus靶场前置条…
阅读更多...
Linux 线程库中的接口介绍

Linux 线程库中的接口介绍

1.pthread_create()创建线程 pthread_create()的语法形式： 参数解释： 第一个参数thread：事先创建好的pthread_t类型的参数。成功时thread指向的内存单元被设置为新创建线程的线程ID。 第二个参数attr：用于定制各种不同的线程属性…
阅读更多...
三角形添加数--夏令营

三角形添加数--夏令营

题目 tips： 1.本题不要求正三角形输出，只要输出左下三角即可 2.这种输入三角形的，都是可以理解为左下三角形的模型，然后去写f[i][j]f[i-1][j]f[i-1][j1]，写行列 3.还有双重for循环输入输出三角形，注意第二…
阅读更多...
数据处理与统计分析——MySQL与SQL

数据处理与统计分析——MySQL与SQL

这里写目录标题 1、初识数据库1.1、什么是数据库1.2、数据库分类1.3、相关概念1.4、MySQL及其安装1.5、基本命令 2、基本命令2.1、操作数据库2.2、数据库的列类型2.3、数据库的字段属性2.4 创建和删除数据库表2.5、数据库存储引擎2.6、修改数据库 3、MySQL数据管理3.1、外键 My…
阅读更多...
YOLOv5+deepsort实现目标追踪。(附有各种错误解决办法）

YOLOv5+deepsort实现目标追踪。(附有各种错误解决办法）

一、YOLOv5算法相关配置 🐸这里如果是自己只想跑一跑YOLOV5的话，可以参考本章节。只想跑通YOLOv5+deepsort的看官移步到下一章节。 1.1 yolov5下载 🐸yolov5源码在github下载地址上或者Gitee上面都有。需要注意的是由于yolov5的代码库作者一直在维护，所以下载的时候需…
阅读更多...
【前端】vscode javascript 代码片段失效问题解决

【前端】vscode javascript 代码片段失效问题解决

1. 文件--首选项--用户代码片段-vue.json : 添加 // { // // Place your global snippets here. Each snippet is defined under a snippet name and has a scope, prefix, body and // // description. Add comma separated ids of the languages where the snippet is app…
阅读更多...
CentOS 7重置root密码

CentOS 7重置root密码

CentOS 7 如何找回被您 遗忘得 root密码呢？ 步骤如下： 步骤一：在开机出现如下界面的时候就按“e”键 步骤二：在步骤一按下”e”键之后，出现如下界面，按 ↓键一直到底部找到“LANG=zh_CN.UTF-8”这句，在这句后面加上“init=/bin/sh”,然后按Ctrl+x进入单用户，此时需要…
阅读更多...
Log4Qt日志框架（1）- 引入到QT中

Log4Qt日志框架（1）- 引入到QT中

Log4Qt日志框架（1）- 引入到QT中 1 下载源码2 简介3 加入到自己的项目中3.1 使用库文件3.2 引入源文件 4 说明 1 下载源码 github：https://github.com/MEONMedical/Log4Qt 官方(版本较老)：https://sourceforge.net/projects/log4q…
阅读更多...
【李群李代数】李群控制器（lie-group-controllers）介绍——控制 SO(3) 空间中的系统的比例控制器Demo...

【李群李代数】李群控制器（lie-group-controllers）介绍——控制 SO(3) 空间中的系统的比例控制器Demo...

李群控制器SO(3)测试 测试代码是一个用于控制 SO(3) 空间中的系统的比例控制器。它通过计算控制策略来使当前状态逼近期望状态。该控制器使用比例增益 kp 进行参数化，然后进行一系列迭代以更新系统状态，最终检查状态误差是否小于给定的阈值。这个控制器用…
阅读更多...
用 Python 算法预测银行客户行为实战案例

用 Python 算法预测银行客户行为实战案例

这是一份kaggle上的银行的数据集，研究该数据集可以预测客户是否认购定期存款y。这里包含20个特征。 1. 分析框架 2. 数据读取，数据清洗 # 导入相关包 import numpy as np import pandas as pd # 读取数据 data pd.read_csv(./1bank-additional-full.…
阅读更多...
谈谈通信工程专业

谈谈通信工程专业

目录 1.什么是通信工程 2.通信工程学什么 3.通信工程就业方向 4.通信工程发展前景 1.什么是通信工程 通信工程是一门工程学科，它涉及到设计、建设和管理通信系统以及相关设备和技术的应用。通信工程主要关注的是信息的传输、交换和处理，旨在实现可靠…
阅读更多...
vue初始化没反应可以换个位置

vue初始化没反应可以换个位置

本来 这个 在最后初始化没反应 ，换到 中间就可以了 created() {this.model Object.assign({}, {});this.loadTreeData();this.initColumnsSetting()},
阅读更多...
Postman返回了一个html页面

Postman返回了一个html页面

问题记录 调用公司的测试环境接口，从浏览器控制台接口处cCopy as cURL(cmd)，获取完整的请求内容，然后导入postman发起请求 提测时发现返回一个html页面，明显是被请求在网管处被拦截了，网关返回的这个报错html页面 …
阅读更多...
第18集丨Vue脚手架的默认配置

第18集丨Vue脚手架的默认配置

目录 一、查看默认配置1.1 在此系统中禁止执行脚本1.2 错误解决方案1.3 执行成功生成的配置项 二、关闭语法检查 一、查看默认配置 Vue脚手架隐藏了所有 webpack 相关的配置，若想查看具体的 webpak 配置，请执行：vue inspect > output.js …
阅读更多...
基于javaweb的社区疫情防控系统

基于javaweb的社区疫情防控系统

摘 要 随着当今网络的发展，时代的进步，各行各业也在发生着变化，于是网络已经逐步进入人们的生活，给我们生活或者工作提供了新的方向新的可能。 本毕业设计的内容是设计实现一个springboot框架的社区疫情防控系统。它是以java语…
阅读更多...
使用 HTML、CSS 和 JavaScript 创建实时 Web 编辑器

使用 HTML、CSS 和 JavaScript 创建实时 Web 编辑器

使用 HTML、CSS 和 JavaScript 创建实时 Web 编辑器 在本文中，我们将创建一个实时网页编辑器。这是一个 Web 应用程序，允许我们在网页上编写 HTML、CSS 和 JavaScript 代码并实时查看结果。这是学习 Web 开发和测试代码片段的绝佳工具。我们将使用ifram…
阅读更多...
第十五章：联邦学习攻防实战

第十五章：联邦学习攻防实战

代码 联邦学习的后门攻击案例 联邦学习的模型压缩案例 联邦学习的差分隐私案例 联邦学习的同态加密案例 联邦学习的参数稀疏化案例
阅读更多...
../../ 目录遍历

../../ 目录遍历

在web功能设计中,很多时候我们会要将需要访问的文件定义成变量，从而让前端的功能便的更加灵活。 当用户发起一个前端的请求时，便会将请求的这个文件的值(比如文件名称)传递到后台，后台再执行其对应的文件。 在这个过程中，如果后…
阅读更多...
推荐文章
最新文章

Copyright @ 2022~2023