深圳公司网站备案需要什么资料,如何写好网站开发技术文档,发布网页,网页模板源代码文章目录 前言一、加速度输出变量问题澄清二、配置Carsim动力学模型三、配置Carsim驾驶员模型四、添加VS Command代码五、Run Control联合仿真六、加速度模型效果验证 前言
1、自动驾驶行业中#xff0c;算法端对于纵向控制的功能预留接口基本都是加速度#xff0c;我们需要… 文章目录 前言一、加速度输出变量问题澄清二、配置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图表由于Vat 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_TCCurErr,0)
EQ_OUT RCumErr_TC IF_GT_0_THEN(ReverseFlag,RCumErr_TCRCurErr,0)
EQ_OUT CumErr_BK IF_NOT_0_THEN(ForwardFlag,0,CumErr_BKCurErr)
EQ_OUT RCumErr_BK IF_NOT_0_THEN(ReverseFlag,0,RCumErr_BKCurErr)!Forward PID(Torque)
EQ_IN Torque_TC P_TC*CurErrI_TC*CumErr_TCD_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*RCurErrI_TC*RCumErr_TCD_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*CurErrI_BK*CumErr_BKD_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*CurErrI_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 ModeTran0Clear 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加速度值给负值 综上完成加速度模型搭建模型可能还有点小缺陷大神们可以指导一下如有问题及时沟通。
