标签: 功能模型接口

在之前的文章中，我们介绍了如何构建简单的车辆模型，并基于FMI2.0构建了其FMU，其最终结构为： 今天将会和大家分享如何在aiSim中，通过UDP和aiSim车辆动力学API（Vehicle Dynamics Interface, VDI）来实现和外部的FMU车辆动力学模型的联合仿真。 一、操作步骤 车辆动力学仿真是aiSim的核心组件，能够根据驾驶指令来确定车辆的运动变化。基于准确可靠的车辆动力学模型，可以确保车辆模拟更加真实。在aiSim可以将FMU单独视作动态库来实现车辆动力学，也可以基于VDI和UDP来实现和FMU的联合仿真。 1、实例化VDI VDI中提供了5种不同的车辆动力学模型，包括： （1）2d：横向自行车模型 （2）23d：底盘俯仰和侧倾分离的横向自行车模型 （3）3d：具有3D刚性车身和独立车轮悬挂的横向轮胎模型（计算量很大） （4）拖车模型：用于牵引车辆 （5）FMU：基于FMI对于车辆动力学的不同描述 整个联合仿真的进程可以分四个部分： （1）根据车辆名称匹配对应的ego （2）在VehicleDB.json或是ego自己的asset包中确认所定义的车辆动力学模型 （3）实例化专属的VDI来处理FMU，定义必须的输入/输出数据 （4）通过socket和pyfmi处理FMU 在实例化VDI时，我们将会遵循以下四个部分来获取车辆动力学的相关数据 2、通过UDP实现FMU的读取 在实例化VDI的同时，初始化一个UDP接口来处理收到的数据。 如果我们通过UDP来实现FMU的读取（为了分布式系统），那么我们还需要pyfmi和socket来协助我们读取和写入FMU的数据，整个脚本主要实现功能为： （1）创建UDP的socket，用于监听和读取来自VDI的数据 （2）解析来自VDI的数据，获取动力学数据和标志信号，后者主要用于步进操作 （3）基于标志信号步进式执行仿真 （4）基于fmipy读取FMU中定义的各种动力学数据，并将其打包成UDP，在读取时，同样遵循modelDescription.xml中的定义。 3、效果展示 在完成以上工作后，可以启动整个进程，看一下分布式联合仿真的效果。FMU和对应的脚本运行在PC1上，aiSim运行在PC2上。 以上就是关于功能模型接口FMI的联合仿真的全部内容，通过FMU我们可以快速的在不同工具之间进行集成，而不需要进行大规模的模型移植或是繁琐的联调。 如果涉及到联合仿真，每个子系统都需要对应的仿真器进行求解，在通信时数据的交换频率和吞吐量都会对延时造成影响，从而造成仿真的偏差，可以优化不同的通信机制或是采用案例中主动触发的方式来减少负面影响。

在上一篇文章：“ 康谋分享 | 自动驾驶联合仿真——功能模型接口FMI（三） ”，我们讲述了在构建FMU中，如何通过fmi_simple_car.cpp来实现FMI2.0，即如何实现一个简单的车辆模型来进行车辆动力学仿真。今天康谋接着展示如何通过simple_car.cpp和simple_car.h构建车辆模型本身。 一、操作步骤 首先simple_car.cpp主要构建了车辆所需的多个动力学参数，包括底盘的位姿、车轮的状态等，而simple_car.h提供多个函数来实现基于FMI2.0标准将参数写入到车辆中。 simple_car.cpp主要分为三部分： 初始化车辆动力学参数 计算参数并更新车辆的运动变化 根据车辆的位姿计算车轮的坐标 在头文件中，除了定义相关函数外，还提供了车辆的一些静态参数，用于协助动力学参数的计算，比如给定车辆的转向传动比、轴距、最大附着加速度、车轮半径等。 1、实例化 我们来看一个simple_car.cpp中实现车辆状态更新的简单示例： constdouble wheel_angle =val_refs / m_steer_transmission_ratio; constdouble curvature = wheel_angle / m_wheelbase constdouble yaw_rate = curvature * val_refs 这三个分别计算了转向角、曲率和偏航率。基于这个三个值，再结合车辆的静态参数，我们可以计算并推算出其他的车辆运动姿态参数。 我们也会通过加速踏板和刹车踏板的状态来计算车辆（底盘的纵向加速度），其中m_max_adh_acc为在头文件中预先定义的最大附着加速度： if val_refs < 0.0 { val_refs = val_refs * m_max_adh_acc; } 可以注意到我们使用了宏定义的 、 和 。 使用这一方式的原因：一是为了计算不同参数时清晰明了，此外更重要的是这和FMU中的modelDescription.xml文件所对应，modelDescription.xml规定了FMU的结构，其结构可以参考FMI系列的第二篇文章：“ 康谋分享 | 自动驾驶联合仿真——功能模型接口FMI（二） ”。 2、关注参数 在XML文件中，需要关注的参数类型为name和valuReference，STEERING_ANGLE这一name对应的valuReference值为3，那么为了方便我们使用这些参数，可以把这些定义的宏写入到value_reference_ids.h中，当然也可以写入simple_car.h这一头文件里。 3、Cmake 编译 在完成simple_car.cpp、simple_car.h和FMU描述文件modelDescription.xml文件的构建，最后一步就是要将其编译成为所需FMU文件并生成我们的动态库文件(.so/.dll)。 我们采用Cmake来进行编译，除了定义源文件、添加库、指定目录、链接库（主要是glm和fmi2_interface）以外，我们还需要针对FMI平台进行配置： 以上就是基于FMI2.0构建FMU的全部内容，在下一期中我们将介绍在仿真软件aiSim中通过车辆动力学API来实现和FMU的联合仿真。

FMU中时间概念的连续性和离散性实际上是变量的属性。并且FMU都能够包含连续时间的变量或是离散时间的变量。在模型交换类型和联合仿真类的FMU通信中可以看到这一点。 在FMI2.0中通过通信点来进行数据交换的通信结构是离散的。 一、模型交换：导入工具提供求解器 仿真工具之间模型集成非常紧密。 在导入工具和模型之间的接口非常复杂。 导入工具必须提供合适的求解器。 二、联合仿真：导出工具提供求解器 模型和求解器之间有着紧密的耦合关系。 导入工具和模型之间的接口相对简单。 可以选择不同的联合仿真算法和通信步长来实现更稳定精确的仿真方案。 三、联合仿真的接口Interface 通信时间步长可以和内部步长不同，通信时间步长主要是不同FMU之间交换信息，而在各自的内部可以时是不同的可变时间步长。 在联合仿真接口中，参数会根据FMI标准有着典型的调用顺序： 得到输出：fmiGetXXX(...) 触发计算直到下一个通信节点：fmidoStep(...) 设置输入值：fmi2SetXXX(...) 以C代码为例： 使用FMI2Instantiate函数实例化FMU CALL instantiationToken, fmi2Flase, fmi2Flase)) 其中涉及到的参数分别是FMI实例、FMU资源的URI、声明FMU的类型为联合仿真、唯一标识符、是否显示FMU的GUI和是否启动日志记录的参数。 应用初始值和输出 CALL (applyStartValues(S, settings)); CALL startTime, true , true , false )); 设置参数并进入初始化模式，如果有FMU初始状态文件的话，可以在实例化FMU后执行 CALL 0 startTime, fmiFalse, 0 )); CALL (FMI2EnterInitializationMode(S)); CALL (FMI2ExitInitializationMode(S)); 进入仿真循环，按照时间步长进行采样和应用输入 for (ubsigned long step = 0 ;; step++) { const outputInterval; ... CALL (FMISample(S, time, result)); CALL (FMIApplyInput(S, input, time, true , true , false )); ...... const outputInterval, fmiTrue); ...... CALL (FMIGetBooleanStatues(S, fmi2Terminated, &terminated)) ...... CALL (FMI2GetRealStatus(S, fmi2LastSuccessfulTime, &lastSuccessfulTime)); CALL (FMISample(S, lastSuccessfulTime, result)); ...... 联合仿真算法作用 联合仿真算法不属于FMI标准的一部分，其作用主要是用于： 推进整个仿真系统的时间，使得各个子系统的FMU组件在 每个时间步长上同步执行仿真计算，即代码中仿真循环的部分。 交换输入和输出数据。 触发时钟信号，用于同步不同仿真组件或触发某些操作，即代码中。 settings startTime + step * settings outputInterval; FMI2DoStep (S, time, settings outputInterval, fmiTrue); 处理事件，例如状态变化、外部输入、内部条件触发等，即代码中。 CALL (FMI2GetRealStatus(S, fmi2LastSuccessfulTime, &lastSuccessfulTime)); CALL (FMISample(S, lastSuccessfulTime, result)); 四、模型描述文件是并行的 模型描述文件modelDescription.xml包含了关于FMU所有的静态信息，其定义了FMU支持的接口类型，无论是模型交换或是联合仿真，同时解释了模型变量，包括了输入、输出以及相关参数，以便导入工具进行访问。 除此之外也会包含模型接口的一些信息，比如模型连接时数据是符合输入输出的。 并且在模型描述文件中还会声明一些属性标志，比如“needsExcutionTool”，这一属性表示需要特定的程序或是特定的库文件才能够执行FMU，所以在导入FMU时，在导入工具中需要一个额外的包装Wrapper，并不真正的参与计算，而是用来实现模型、求解工具和执行之间进行通信。