Milestone文档

技术背景

仿真的基本概念

本文档中,仿真是指用计算机计算,对物理过程进行模拟的方法。通过计算机仿真的手段,能够对被设计产品的数学模型进行模拟研究,估计预期的动态性能,实现基于模型的设计。

首先,需要对被模拟对象的动态物理过程进行数学建模(简称建模),获得简化的数学模型,如常微分方程(ordinary differential equation,ODE),或微分代数方程(differential algebra equation,DAE)等形式。然后,复杂的数学模型表现为多变量的方程组,难以直接给出各变量随时间变化的解析形式,往往需要借助计算机上的通用数值算法,对数学模型进行数值求解(简称求解)。

求解方面,已经有众多成熟的仿真软件工具,将通用数值算法形成模型求解器(solver),如MATLAB/Simulink、LabVIEW、ADAMS、AMESim、SimulationX、Silver等等。

建模方面,随着被研究对象数学模型的复杂度增加,为便于开发、测试与功能复用,将其进行模块化分割成为必须的手段。

反过来,对模块化的部件模型进行接口的连接,才能形成代表被模拟对象的系统仿真模型,称该过程为模型集成(简称集成)。

前面提到的仿真软件工具,一些兼具建模功能,一些仅对模型进行集成,多数软件则兼具建模和集成功能。在对航空、航天器,汽车等复杂的被模拟对象进行数学建模时,其往往包含力学、热学、电学、自动控制和软件等不同领域的设计特征,是一个多学科交叉系统;不同仿真软件所针对的物理领域往往不同,单一软件难以方便地实现多学科交叉系统的建模。因而,需要在不同仿真软件的模块化部件模型集成方面,形成可交换的标准接口,使得在不同仿真软件内建立的模型可以相互导入、导出,实现对多源异构模型的集成和系统仿真。

本系统着力解决的问题

目前,主要的模型标准接口为S-Function与Functional Mock-up Interface, FMI。S-Function为Simulink的模型开发接口,应用较为广泛;对于集成已有的C/C++代码,具有Legacy Code Tool, LCT代码导入工具以及图形化的向导工具S-Function Builder;但由于Simulink是商业工具,其他工具仅支持S-Function模型的导出,S-Function模型的导入和求解仅能在Simulink中进行。

FMI是一种还在发展之中的开放接口标准,由国际性的产业联盟维护,已在汽车行业广泛支持。符合FMI接口标准的模型为Functional Mock-up Unit, FMU,其模型端(model slave)与求解端(solver master)的实现都有开源软件实现范例,因而越来越多的工具支持FMU模型的导入、导出以及系统集成仿真。但是,FMI标准的技术细节多,相关工具链自动化程度低,对于技术人员的编程水平要求较高;对于集成已有的C/C++代码,需要熟悉C代码模板的运行流程,定义一维展开的接口变量,完成与已有模型接口数据结构的相互转换,编制FMU描述文件(modelDescription.xml),编译各运行平台下的动态链接库,FMU目录结构的创建,FMU的打包及测试等等工作。一般用户难以实现复杂的功能,使用的便利性不足。

针对使用FMI接口标准集成已有的C/C++代码自动化程度低,开发门槛高等问题,对FMI及S-Function模型接口标准的运行流程进行提炼和抽象,在FMI接口代码模板基础上进行扩展,提供外部资源和定时任务的统一管理接口,形成通用的中间层(图 1.1);开发图形向导式的接口适配工具,能够自动完成已有模型接口数据结构与FMI中一维展开的接口变量间的相互转换,自动生成模型描述文件,并能够一次编码同时支持FMI及S-Function模型接口标准。

_images/layer.svg

系统功能定位

主要功能特性

  1. 用于模型在环仿真(MiL)的C/C++代码集成工具

  2. 简捷、统一,一次编码同时支持FMI及S-Function模型接口标准

  3. 对外部资源及定时任务提供了自动化的管理接口,便于模型中引用

  4. 使用CMake构建系统,可自动适配大多数编译器

  5. 使用Qt图形界面,可运行于大部分操作系统的桌面环境

  6. 与来自IBK的MasterSimulator环境集成发布,便于FMU集成仿真

  7. 生成平台相关的代码,兼容Windows及Linux

  8. 生成的模型可运行在基于Linux的半实物仿真(HiL)系统

对FMI及S-Function模型接口标准的运行流程进行提炼和抽象,在FMI接口代码模板基础上进行扩展,形成通用的中间层; 开发了向导式图形界面,能够辅助用户建立中间层接口函数模板,包括实例化、初始化,步进,重置以及终止,还扩展了外部资源和定时任务的统一管理接口,便于用户在模型代码中引用; 开发了接口解析及代码生成工具,能够递归地解析用户模型定义文件中的接口数据定义,建立已有模型接口数据结构与FMI中所需的一维展开的接口变量间的映射关系; 用户只需一次编写模型定义及实现代码,能够同时支持FMI及S-Function模型接口标准,自动生成FMU模型对应的FMI接口代码文件以及FMU描述文件,同样的信息也用于自动生成S-Function模型对应的LCT接口代码文件以及LCT模型定义文件。

安装与配置

软件授权

提供运行系统的MAC地址,联系 WeChat:latitude_vocal 获取授权文件。

Windows

Windows下查看本机MAC地址的方式:查看本地网络连接中的适配器属性,或者在命令提示符窗口(组合键WIN+R,键入cmd)中运行 ipconfig /all

Linux

在X Window配置界面中查看网络适配器属性,或在控制台窗口中运行 ifconfig

软件安装

工具包解压缩得到主目录结构。 将授权文件放置在license目录中。

目录结构

目录/文件

内容

bin

可执行文件及脚本,请勿修改

build

模型构建过程中的临时目录

env

所依赖的软件环境安装程序

export

导出的FMU及测试工程目录

include

模型模板的头文件目录,请勿修改

license

授权文件的放置目录

model

模型代码的存放目录

CMakeLists.txt

CMake工程文件模板,界面程序运行时请勿修改

SFcnLists.m

S-Fcuntion构建脚本文件,界面程序运行时请勿修改

Readme.txt

简要的使用说明文件

外部依赖环境配置

编译器

Windows

推荐Visual Studio中的cl编译器,注意不要使用绿色安装。示例代码在VS2010及以上版本中经过测试,但推荐使用VS2013及以上的版本,以支持C99中的编码习惯。

Linux

推荐使用gcc/g++或clang/clang++编译器,推荐在系统的包管理器中安装。 在Linux下使用图形界面需要配置Qt运行环境,若系统的Qt环境不满足要求,可单独安装Qt开发环境,并在运行GUI程序前设置环境变量: export LD_LIBRARY_PATH=/home/user/Qt5.12.5/5.12.5/gcc_64/lib/ (应替换为用户本地的安装路径) 然后,执行GUI程序 ./MasterSimulatorUI

CMake

开发工具包执行需要部署CMake运行环境。 此外Windows下还要部署VC++运行时环境。 完整版工具包的env中包含相应的安装文件。 Linux下,需要授予bin目录下程序执行权限(chmod 777 ./bin/*)。

路径配置

在MasterSim中选择当前系统中安装的CMake路径以及milestone可执行文件的路径,如 图 2.1

_images/settings.png

配置Milestone相关工具路径

切换界面语言

在MasterSim中切换Milestone的界面语言,重新启动后生效,如 图 2.2

_images/language.png

设置Milestone界面语言

示例教程

运行示例

在了解仿真模型实现的细节之前,可以使用工具包自带的测试用例验证环境部署的正确性,我们先在GUI中快速完成这些操作。

  • 运行MasterSimulatorUI.exe,启动MasterSim主界面,如 图 3.1

_images/01.png

MasterSim主界面

  • 点击“Build model”,打开Milestone工具主界面,如 图 3.2

_images/16.png

Milestone主界面

  • 此处我们直接运行示例模型,切换至“代码生成”标签页,点击“创建工程”,如 图 3.3

_images/22.png

创建工程

  • 弹出模型选择对话框,在模型列表中选择controller和plant模型,如 图 3.4

_images/32.png

选择模型

  • 点击“创建工程”,完成编译工程的创建,如 图 3.5

_images/42.png

完成编译工程创建

  • 点击“构建模型”,调用系统的编译环境,如 图 3.6

_images/52.png

构建模型

  • 在工具包的export目录中,查看生成的FMU文件,如 图 3.7

_images/62.png

查看导出的FMU

  • 在MasterSim主界面中打开自带的测试工程,如 图 3.8

_images/72.png

打开MasterSim测试工程

  • 测试工程在export/mastersim路径下,如 图 3.9

_images/82.png

测试工程默认路径

  • 我们这里重新生成了其中的FMU模型,但他们的连接保持测试工程中的关系不变,如 图 3.10

_images/92.png

MasterSim中的模型连接

  • MasterSim左侧的功能选择按钮可以启动Milestone,测试FMU中的信息,启动后处理程序,以图或表格的方式配置模型间的连接,以及配置仿真求解器参数等,请参考其 官方文档 获得更详细的信息。此处可直接使用示例中配置好的参数,点击“开始仿真”按钮,如 图 3.11

_images/102.png

MasterSim中的仿真配置

  • 观察仿真器的监控信息,以及打印模型中输出的信息,如 图 3.12

_images/112.png

MasterSim仿真过程监控

  • 生成的结果数据文件存放在results路径下,如 图 3.13

_images/122.png

MasterSim仿真结果路径

  • 识别该csv文件的分隔符,用Excel等工具格式化查看,如 图 3.14

_images/132.png

Excel中查看结果csv数据文件

  • 绘制仿真结果,验证模型的正确性,如 图 3.15

_images/141.png

系统时域响应曲线

示例模型说明

控制器模型为PD测速反馈控制器,如 Eq.3.1

()\[F=k_p\left( r_x-x \right) -k_dv\]

被控对象为简单的一维质量块模型,如 Eq.3.2

()\[\begin{split}\left[ \begin{array}{c} \dot{x}\\ \dot{v}\\ \end{array} \right] = \left[ \begin{array}{c} v\\ \frac{F}{m}\\ \end{array} \right]\end{split}\]

所组成控制系统的原理框图如 图 3.16 所示。

_images/sys_all.png

控制系统框图

系统的传递函数为 Eq.3.3

()\[\frac{X\left(s\right)}{R\left(s\right)}= \frac{ k_p \frac{1}{s} \frac{\frac{1}{ms}}{1+k_d*\frac{1}{ms}} }{ 1 + k_p \frac{1}{s} \frac{\frac{1}{ms}}{1+k_d*\frac{1}{ms}} } = \frac{ \frac{k_p}{ms^2+k_ds} }{ 1 + \frac{k_p}{ms^2+k_ds} } = \frac{k_p}{ms^2 + k_ds + k_p} = \frac{1}{\frac{ms}{k_p}s^2 + \frac{k_d}{k_p}s + 1}\]
()\[D\left(s\right) = \frac{ms}{k_p}s^2 + \frac{k_d}{k_p}s + 1=\frac{1}{\omega_n^2}s^2 + 2\frac{\zeta}{\omega_n}s + 1\]

可见该反馈控制系统为典型的二阶系统,其特征方程为 Eq.3.4 , 为使得系统的响应具有较明显的动态过程,选择系统参数使得阻尼比较小且振荡频率为 \(0.5 \mathrm{Hz}\) 即取 \(\zeta=0.2, \omega_n=2\pi \times 0.5\) ,则系统的反馈增益为 \(k_p = \omega_n^2 m, k_d = 2 \zeta \omega_n m\) 。 对于这个简单的模型,当然没有必要分别使用不同的仿真工具对其不同部分进行建模, 但我们为了快速验证系统运行的正确性,可以以此作为测试用例,容易给出在Simulink中的仿真结果与设计的预期相一致,如 图 3.17

_images/sys_res.png

预期的系统响应

接下来,将控制器和被控对象分别实现为两个模型,通过接口的连接实现该系统的仿真,则系统的接口关系为 图 3.18

_images/sys_sep.png

系统的接口关系

图形用户界面操作

新建模型并生成模板

请先参考编辑模型的操作,如 打开已有的模型头文件

若要全新创建模型,请先备份并复制示例模型的全局接口头文件与模型目录结构,编辑全局接口头文件中的接口数据类型定义; 然后,选择工作路径到工具包中创建好的模型代码目录:点击“设置工作路径”按钮,打开系统的路径选择对话框,拾取工具包中的model/model_name/sources目录,如 图 4.1 。 然后,通过界面中的相应区域,填写模型头文件中的信息,生成代码模板,其他操作同编辑已有模型。

_images/1.png

设置工作路径

打开已有的模型头文件

通过界面中的相应区域,修改从模型头文件中载入的信息。

  • 点击“打开已有模型”按钮,打开系统的文件选择对话框,拾取模型的头文件,如 图 4.2

_images/2.png

打开已有模型

  • 点击“加载接口协议文件”按钮,打开系统的文件选择对话框,拾取interface.h全局接口头文件,如 图 4.3

_images/3.png

加载接口协议文件

  • 从左侧列表解析出的接口数据结构中,点选拖动结构体定义到右侧输入、输出接口定义区域,如 图 4.4

_images/4.png

拖动结构体定义到输入

  • 也可以直接键入接口定义表格中的内容,录入后可以通过中间的编辑按钮,对输入、输出列表中的行数据进行编辑,如 图 4.5

_images/5.png

拖动结构体定义到输出

  • 点击上方标签页,切换至“计划任务”,如 图 4.6 。其中task ID为可选的录入区域,系统会自动从零开始编号;按照表头键入任务的定时周期和启动偏移时间;左侧的编辑按钮可对已经录入的行进行整体编辑。

_images/6.png

定义计划任务

  • 点击上方标签页,切换至“外部资源”,如 图 4.7 。其中resource ID为可选的录入区域,系统会自动从零开始编号;按照表头键入资源文件的文件名(运行时文件需要预先放置到模型的resources目录);左侧的编辑按钮可对已经录入的行进行整体编辑。

_images/7.png

定义外部资源

  • 点击上方标签页,切换至“代码生成”。点击“生成代码”将在当前工作路径生成模型的头文件和源文件模板,对于打开的已有模型,仅更新头文件,不会覆盖已经实现的模型源文件,并给出提示,如 图 4.8

_images/8.png

生成代码

  • 点击“编辑代码”,将使用配置中选择的编辑器打开已经生成的模型头文件和源文件,如 图 4.9

_images/9.png

编辑代码

  • 点击“创建工程”,弹出模型选择对话框,在列表中选择需要构建的模型,如 图 4.10 。确定后开始创建工程。

_images/10.png

选择要构建的模型

  • 观察创建工程过程中控制台输出的信息,如 图 4.11 ,请确认对系统中编译环境的测试是否通过。

_images/11.png

开始创建,确认编译环境测试通过

  • 构建完成后控制台输出信息结束,如 图 4.12

_images/12.png

完成创建,确认生成编译工程

  • 点击“构建模型”,开始编译、模型打包与测试过程,如 图 4.13 。请确认工具包授权检测通过,并生成了相关文件。

_images/13.png

开始构建,确认授权通过

  • 构建完成后将对生成的FMU进行零输入测试,给出运行报告,如 图 4.14

_images/14.png

完成构建,确认测试通过

模型模板的代码结构及资源接口

参见 FMI接口及其实现

命令行操作

运行示例

为使开发者从整体上把握工具包的组织方式,这里具体地给出测试用例在CLI中的执行方式如下。

  1. 在工具包根目录下执行”mkdir build” //建立单独的构建目录,名称任意,用于将临时文件与工具分开

  2. 在工具包根目录下执行”cd build” //切换到创建的构建目录

  3. 在创建的构建目录下执行”cmake ..” //在构建目录下,指定代码目录在上层目录,生成编译工程文件(Windows下为MSVC sln,Linux下为Makefile)

  4. 在创建的构建目录下执行”cmake –build . ” //执行构建,注意”.”为当前目录,附加”–config Release”或”–config Debug”参数切换Release版和Debug版,默认为Debug版

  5. 所导出的fmu模型在export目录中

  6. 依次在不同系统下执行工具包,将model目录(保留已生成的中间文件)或整个工具包复制到其他系统继续构建,将获得同时支持多系统的fmu文件

添加模型

  1. 复制model内部的模型目录结构(内部sources文件夹为必须),实现与模型文件夹同名称的.h及.cpp模型代码文件

  2. 若增加新的模型间接口,在model/interface.h中定义接口数据结构体

  3. 在顶层CMakeLists.txt中”foreach (MODEL_NAME controller plant plant_1) # add model to this list”语句处,将新的模型添加在列表中

  4. 重新执行上述构建操作,系统将执行增量构建

构建模型

为避免污染程序目录结构,支持shadow构建,运行CMake,生成编译工程,如 图 5.1

_images/cmake_make.png

创建shadow build目录,生成构建工程(Windows)

程序将完成结构多层次递归展开,FMU结构代码生成,xml描述文件生成,如 图 5.2

_images/cmake_build.png

通过CMake执行编译及后处理

程序完成FMU链接库构建,打包及测试流程,如 图 5.3

_images/package_test.png

FMU的自动打包和测试

FMI接口及其实现

本工具在FMI接口代码的基础上,简化了多数固有的流程性代码以及繁琐的接口定义操作,并添加了一些实用功能,代码模板的运行流程如 图 6.1 。代码的实现请阅读 代码结构剖析 相关注释。

_images/milestone_flow.png

模型代码模板运行流程

代码结构剖析

全局接口头文件

称interface.h文件为全局接口头文件,用于对模型间公用的接口数据类型进行定义。 对于我们的测试用例,从 图 3.18 中可以看出, 控制器需要从被控对象反馈当前的位置和速度,运算后输出推力,而被控对象受到力的作用后,经过其动力学微分方程,其状态量(位置和速度)发生变化。 因而,我们在interface.h中定义了如下的数据结构用于传递两个模型间需要通信的数据。

typedef struct _struct_name
{
    data_type struct_field;
    ...
}struct_name;

全局接口头文件interface.h中的内容:

 1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
#ifndef INTERFACE_H__    /* 避免重复包含 */
#define INTERFACE_H__
//==================================================================/
// A test case for fmi simulation tools
// Copyright (c) 2019 马玉海
// All rights reserved.
//
// Version 1.0
//==================================================================/
#define _CRT_SECURE_NO_WARNINGS    /* 抑制cl编译器对传统标准库的警告 */
#include <math.h>
#include <stdio.h>
#include <stdlib.h>
#include <memory.h>
#include <string.h>
#include <float.h>

#define IO_PORT_FLUSH(data_type, var_name) \    /* 工具宏定义,用于重置端口数据 */
    do{\
        memset(&(p->var_name), 0, sizeof(data_type));\
    } while(0);

#ifndef __cplusplus    /* 针对C89的兼容性定义 */
#define FMI_EXPORT
#define bool unsigned char
#define true 1
#define false 0
#else
#define FMI_EXPORT extern "C"    /* 针对C++的兼容性定义 */
#endif

#ifndef _WIN32    /* 针对Linux的兼容性定义 */
#include <limits.h>
#define _MAX_PATH PATH_MAX
#define _MAX_FNAME NAME_MAX
#define _MAX_EXT NAME_MAX
#endif
// non-standard interface definition
#define FMI_IN    /* 输入端口格式标记 */
#define FMI_OUT    /* 输出端口格式标记 */
#define FMI_PRM    /* 参数端口格式标记(暂未使用) */
typedef const char * fmi_str_ptr;    /* 运行时的内部资源文件路径类型 */

FMI_EXPORT void *fmi_instantiate(void);    /* 导出接口函数声明 */
FMI_EXPORT int fmi_initialize(void *);
FMI_EXPORT int fmi_doStep(void *);
FMI_EXPORT int fmi_reset(void *);
FMI_EXPORT void fmi_freeInstance(void *);

#pragma pack(push, 8)    /* 强制结构体内部字节对齐 */
typedef struct _Stru_Data_Controller_To_Plant_ex    /* 测试定义格式0 */
{
    double y;
    double z;
}Stru_Data_Controller_To_Plant_ex;

typedef struct _Stru_Data_Controller_To_Plant_ex1{    /* 测试定义格式1 */
    double y;
    double z;
}Stru_Data_Controller_To_Plant_ex1;
typedef struct _Stru_Data_Controller_To_Plant_ex2 {    /* 测试定义格式2 */
    double y;
    double z;
}Stru_Data_Controller_To_Plant_ex2;
typedef struct _Stru_Data_Controller_To_Plant_ex3   {    /* 测试定义格式3 */
    double y;
    double z;
}Stru_Data_Controller_To_Plant_ex3;

typedef struct _Stru_Data_Controller_To_Plant{    /* 接口结构体定义1 */
    double F;
    double x_0;
    double v_0;
}Stru_Data_Controller_To_Plant;

typedef struct _Stru_Data_Plant_To_Controller    /* 接口结构体定义2 */
{
    double x;
    double v;
}Stru_Data_Plant_To_Controller;

#pragma pack(pop)    /* 恢复结构体内部字节对齐 */

#endif // INTERFACE_H__

控制器模型

为实现 Eq.3.1 中描述的控制器数学模型并与被控对象模型相连接,分解后的控制器原理框图如 图 6.2

_images/sys_controller.png

控制器原理框图

模型头文件controller.h的内容:

 1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
#ifndef CONTROLLER_H__
#define CONTROLLER_H__

//==================================================================/
// Milestone: A test case for fmi simulation tools
// Copyright (c) 2019, MA Yuhai
// All rights reserved.
//
// Version 1.0
//==================================================================/

#include "interface.h"

#define FMI_MODEL_AUTHOR "MA Yuhai"    /* 模型作者 */
#define FMI_MODEL_NAME "controller"    /* 模型名称 */
#define FMI_MODEL_DISCRIPTION "a controller model"    /* 模型描述 */
#define FMI_PORT_POSTFIX ""    /* 端口后缀 */

// resource file definition if any    /* 外部资源文件需要放置在模型的resources目录下 */
#define FMI_RESOURCE_ITEM 2    /* 外部资源文件数量定义 */
#if FMI_RESOURCE_ITEM>0 && defined EN_RES_ACCESS
const char *resource_file_list[FMI_RESOURCE_ITEM] = {
    "init_config.txt", "init_data.dat" };    /* 外部资源文件名称定义列表 */
#endif                                       /* 列表中超出FMI_RESOURCE_ITEM的项目将被忽略 */

// task definition if any in the unit of [ms]    /* 格式task_[period]ms_start_[offfset]ms */
#define FMI_TASK_ITEM 2    /* 计划任务数量定义 */
FMI_EXPORT void task_30ms_start_0ms(void);    /* 计划任务触发函数1 */
FMI_EXPORT void task_100ms_start_1030ms(void);    /* 计划任务触发函数2 */

// define interface variables by an fmi object
// one statement per line, no extra semicolons allowed
// do not modify internal variables
typedef struct st_fmi_object_t {
    // internal variables    /* 必须的内部变量,当前时间、步长和文件列表 */
    FMI_IN double fmi_time_current;
    FMI_IN double fmi_time_step;
#if FMI_RESOURCE_ITEM>0
    FMI_PRM fmi_str_ptr fmi_file_list[FMI_RESOURCE_ITEM];    /* 运行时可用的外部资源文件名列表 */
#endif

    // interface variables
    FMI_IN Stru_Data_Plant_To_Controller st_data_plant_to_controller;    /* 输入接口结构体 */
    FMI_OUT Stru_Data_Controller_To_Plant st_data_controller_to_plant;    /* 输出接口结构体 */
    FMI_OUT double task_30ms_status;    /* 自定义输出1,30ms任务监控 */
    FMI_OUT double task_100ms_status;    /* 自定义输出2,100ms任务监控 */
}st_fmi_object;    /* 模型名称 */
#endif // CONTROLLER_H__

模型源文件controller.cpp中的内容:

  1
  2
  3
  4
  5
  6
  7
  8
  9
 10
 11
 12
 13
 14
 15
 16
 17
 18
 19
 20
 21
 22
 23
 24
 25
 26
 27
 28
 29
 30
 31
 32
 33
 34
 35
 36
 37
 38
 39
 40
 41
 42
 43
 44
 45
 46
 47
 48
 49
 50
 51
 52
 53
 54
 55
 56
 57
 58
 59
 60
 61
 62
 63
 64
 65
 66
 67
 68
 69
 70
 71
 72
 73
 74
 75
 76
 77
 78
 79
 80
 81
 82
 83
 84
 85
 86
 87
 88
 89
 90
 91
 92
 93
 94
 95
 96
 97
 98
 99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
#include "controller.h"
#include <iostream>    /* 不限制模型内部的实现方式,可以使用C++的类、STL等特性 */
#include <fstream>
#include <string>
using namespace std;

double x;    /* 可以在模型内部自定义全局变量 */
double v;
double F;
double x_0;
double v_0;
int task_30ms_trigger;
int task_100ms_trigger;

void load_initial_data(fmi_str_ptr fmi_file_list[])    /* 可以在模型内部自定义函数 */
{
    ifstream init_file;

    init_file.open(fmi_file_list[0]);
    if (!init_file.is_open()) {
        cout << "open data file error: " << fmi_file_list[0] << endl;
    }
    else {
        string buff;
        getline(init_file, buff);
        cout << buff << endl;    /* 打印资源文件中的内容 */
    }

    init_file.close();

    init_file.open(fmi_file_list[1]);
    if (!init_file.is_open()) {
        cout << "open data file error: " << fmi_file_list[1] << endl;
    }
    else {
        init_file >> x_0;    /* 读取资源文件中的内容作为初始值传递给被控对象 */
        init_file >> v_0;    /* 注意!一般情况下这并不会生效,和求解器的实现方式有关 */
    }    /* 一般情况下,初始化阶段不会按照模型的连接关系按顺序执行,并交换接口变量 */

    init_file.close();
    return;
}

void task_30ms_start_0ms(void)    /* 头文件中定义的定时任务触发函数必须实现 */
{
    task_30ms_trigger = task_30ms_trigger ? 0 : 1;
}

void task_100ms_start_1030ms(void)
{
    task_100ms_trigger = task_100ms_trigger ? 0 : 1;
}

void* fmi_instantiate(void)    /* 实例化函数,在模型加载后被调用 */
{
    st_fmi_object *p =    /* 模板内容均为必须的操作,请勿删除 */
        (st_fmi_object *)calloc(1, sizeof(st_fmi_object));
    if (!p) {
        fprintf(stderr, "fmi_instantiate failed in model controller!\n");
        exit(EXIT_FAILURE);
    }
    /* 在模板代码后,可添加自定义的操作,如打印信息 */
    return p;
}

int fmi_initialize(void *fmi_object)    /* 初始化函数,在模型启动或重置时被调用 */
{
    st_fmi_object *p = (st_fmi_object *)fmi_object;

    load_initial_data(p->fmi_file_list);    /* 可通过p指针访问接口上的所有变量及文件资源 */
    p->st_data_controller_to_plant.x_0 = x_0;
    p->st_data_controller_to_plant.v_0 = v_0;

    return 0;
}

int fmi_doStep(void *fmi_object)    /* 步进函数,每一个步长推进的周期被调用 */
{
    st_fmi_object *p = (st_fmi_object *)fmi_object;
    const double pi = 3.1416;    /* 可在模型中自定义参数常量 */
    const double r_x = 5;
    const double m = 0.1;

    const double zeta = 0.2; // let it oscillates
    const double omega_n = 2*pi*0.5;
    const double k_p = omega_n*omega_n*m;
    const double k_d = 2*zeta*omega_n*m;

    x = p->st_data_plant_to_controller.x;    /* 可选择将接口内存变量赋值到较方便的名称 */
    v = p->st_data_plant_to_controller.v;

    F = k_p * (r_x - x) - k_d * v;    /* 执行模型计算 */

    p->st_data_controller_to_plant.F = F;    /* 将计算后的结果发布到接口内存上 */
    p->task_30ms_status = task_30ms_trigger;
    p->task_100ms_status = task_100ms_trigger;

    return 0;
}

int fmi_reset(void *fmi_object)    /* 复位函数,在重置模型时被调用 */
{
    st_fmi_object *p = (st_fmi_object *)fmi_object;
    IO_PORT_FLUSH(Stru_Data_Controller_To_Plant, st_data_controller_to_plant);    /* 清空输出接口内存 */
    return 0;
}

void fmi_freeInstance(void *fmi_object)    /* 释放函数,在模型卸载时被调用 */
{
    st_fmi_object *p = (st_fmi_object *)fmi_object;

    free(p);
}

被控对象模型

为实现 Eq.3.2 中描述的被控对象模型并与控制器数学模型相连接,分解后的被控对象原理框图如 图 6.31

_images/sys_plant.png

被控对象原理框图

模型头文件plant.h中的内容:

 1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
#ifndef PLANT_H__
#define PLANT_H__
//==================================================================/
// A test case for fmi simulation tools
// Copyright (c) 2019 马玉海
// All rights reserved.
//
// Version 1.0
//==================================================================/

#include "interface.h"

#define FMI_MODEL_AUTHOR "MA Yuhai"
#define FMI_MODEL_NAME "plant"
#define FMI_MODEL_DISCRIPTION "a plant model"
#define FMI_PORT_POSTFIX ""    /* 指定端口后缀,避免在某些仿真工具中的命名冲突 */

// resource file definition if any
#define FMI_RESOURCE_ITEM 0    /* 外部资源文件数量为零,列表被忽略 */
#if FMI_RESOURCE_ITEM>0 && defined EN_RES_ACCESS
const char *resource_file_list[FMI_RESOURCE_ITEM] = {
    };
#endif

#define FMI_TASK_ITEM 0    /* 定时任务数量为零,触发函数被忽略 */
// task definition if any in the unit of [ms]
void task_30ms_start_0ms(void);

// define interface variables by an fmi object
// one statement per line, no extra semicolons allowed
// do not modify internal variables
typedef struct st_fmi_object_t{
    // internal variables
    FMI_IN double fmi_time_current;
    FMI_IN double fmi_time_step;
#if FMI_RESOURCE_ITEM>0
    FMI_PRM fmi_str_ptr fmi_file_list [FMI_RESOURCE_ITEM]; // do not delete the spaces around []
#endif

    // interface variables
    FMI_IN Stru_Data_Controller_To_Plant st_data_controller_to_plant;
    FMI_OUT Stru_Data_Plant_To_Controller st_data_plant_to_controller;
}st_fmi_object;

#endif // PLANT_H__

模型源文件plant.cpp中的内容:

 1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
#include "plant.h"

double x;
double v;
double F;

void* fmi_instantiate(void)
{
    st_fmi_object *p =
        (st_fmi_object *)calloc(1, sizeof(st_fmi_object));
    if (!p) {
        fprintf(stderr, "fmi_instantiate failed in model plant!\n");
        exit(EXIT_FAILURE);
    }

    return p;
}

int fmi_initialize(void *fmi_object)
{
    st_fmi_object *p = (st_fmi_object *)fmi_object;

    x = p->st_data_controller_to_plant.x_0;
    v = p->st_data_controller_to_plant.v_0;

    return 0;
}

int fmi_doStep(void *fmi_object)
{
    st_fmi_object *p = (st_fmi_object *)fmi_object;
    const double m = 0.1;

    F = p->st_data_controller_to_plant.F;

    v += F / m * p->fmi_time_step;    /* 当前时间、步长会由仿真工具更新 */
    x += v * p->fmi_time_step;

    p->st_data_plant_to_controller.x = x;
    p->st_data_plant_to_controller.v = v;

    return 0;
}

int fmi_reset(void *fmi_object)
{
    st_fmi_object *p = (st_fmi_object *)fmi_object;
    IO_PORT_FLUSH(Stru_Data_Plant_To_Controller, st_data_plant_to_controller);
    return 0;
}

void fmi_freeInstance(void *fmi_object)
{
    st_fmi_object *p = (st_fmi_object *)fmi_object;

    free(p);
}

Footnotes

1

可参考示例模型plant_1,查看构建后的代码及接口是否添加了期望的后缀。

S-Function接口及其实现

生成fmu的过程中,在模型的sources目录中也生成了支持Simulink导入的S-Function接口代码。

若要生成模型的S-Function模块,在顶层SFcnLists.m中”model_list = {‘controller’, ‘plant’}; % add model to this list”语句处,将新的模型添加在列表中。

启动MATLAB,将工作路径切换至工具包根目录,运行SFcnLists.m脚本,将执行S-Function的代码生成和模块构建。

保存获得的Simulink模型模块,以及工作空间中的数据总线定义,分发模型时还需要附加*.mexw32/*.mexw64二进制文件,以及模型所需的数据文件。

下面的示例仍以教程中的模型为例,演示使用S-Function模块进行集成仿真的具体过程。

  • 运行SFcnLists.m脚本后,将一一生成列表中模型对应的S-Function模块,如 图 7.1

_images/0.png

生成的S-Function模块

  • 在MATLAB的工作空间(Workspace)中,将生成的总线(Bus)定义备份,如 图 7.2

_images/15.png

工作空间中的总线数据定义

  • 在模型对应的代码目录(sources)下,将生成的S-Function所对应的二进制文件一一备份,如 图 7.3

_images/21.png

S-Function所对应的二进制文件

  • 在Simulink中将多个S-Function模型连接为仿真工程,并显示其间的总线数据流,如 图 7.4

_images/31.png

Simulink中集成生成的S-Function模型

  • 此时若直接运行仿真工程,可能出现代数环错误,如 图 7.5

_images/41.png

代数环错误

  • 在Simulink模块库中,找到并添加“Memory”模块到工程中,如 图 7.6

_images/51.png

Memory模块

  • 在Simulink模块库中,找到并添加“Scope”模块到工程中,如 图 7.7

_images/61.png

Scope模块

  • 在Simulink模块库中,找到并添加“Bus Selector”模块到工程中,如 图 7.8

_images/71.png

Bus Selector模块

  • 将Bus Selector模块拖放到plant输出的数据总线上,点击选择要析取的信号,如 图 7.9

_images/81.png

通过Bus Selector析信号

  • 打开Simulink的仿真求解器配置页面,设置定步长求解器,步长0.005s,如 图 7.10

_images/91.png

仿真求解器配置

  • 将备份的总线数据结构文件(.mat)导入到工作空间中,并将S-Function的二进制文件复制到工程当前路径下,如 图 7.11

_images/101.png

准备总线及二进制文件

  • 将模型依赖的其他数据文件复制到工程当前路径下,如 图 7.12

_images/111.png

准备数据文件

  • 配置好的Simulink仿真工程及仿真结果,如 图 7.13

_images/121.png

Simulink仿真结果

  • 模型中打印到标准输出的调试信息,被重定向至Simulink状态栏中部的诊断监视窗口,如 图 7.14

_images/131.png

Simulink诊断监视窗口

系统实现细节

功能及组成

仿真模型接口适配开发系统主要由向导式图形界面(简称界面程序)与接口解析及代码生成工具(简称接口程序)构成,并借助系统提供的代码编辑工具,编译构建工具(典型的如make,nmake或CMake等),C/C++编译环境等通用组件完成FMU模型及S-Function模型(统称为模型)的接口适配工作;对于生成FMU模型,还需要系统管理工具与FMI测试工具;对于生成S-Function模型,还需要MATLAB/Simulink软件。

具体的,系统组成关系如 图 8.1 。其中向导式图形界面主要由公用数据结构定义文件解析(用于提供用户可选择的数据类型)、用户模型定义文件解析(用于重新编辑用户已经配置过的模型)、FMU构建脚本生成、S-Function构建脚本生成以及模型用户代码模板生成等部分组成;此外还包括若干通用界面组件,主要有可交互表格控件、多语言界面样式及布局、操作信号传递与处理、系统配置持久化、外部进程调用及监测以及模型目录状态监测等。接口解析及代码生成工具主要由用户模型定义文件解析、公用数据结构定义文件解析、FMI接口代码文件生成、FMU描述文件生成、LCT接口代码文件生成以及LCT模型定义文件生成等部分组成。

_images/component.svg

系统组成关系

运行流程

系统架构及工作流程如 图 8.2 所示。具体的,系统的工作步骤为:

Step-1:用户操作界面程序,可以创建或编辑已有的模型定义文件内容,包括模型信息定义,外部资源定义,定时任务定义以及接口数据定义。其中模型信息包括模型名称,作者,备注,及端口后缀等;对于外部资源定义,包括路径,文件名,后缀名等;对于定时任务定义,包括任务周期,起始时间偏移等;对于接口数据定义,包括输入、输出及参数的数据类型和变量名称,用户可以直接编辑录入,也可以加载公用数据结构定义文件,界面程序解析其中的C语言结构体定义,并形成可供用户选择的数据结构列表,用户可以拖拽列表中的项目,将其添加至模型的接口数据定义区域内。

Step-2:用户填写完界面程序中的信息后,可以操作生成模型用户代码,包括用户模型定义文件及用户模型实现文件。其中用户模型定义文件完全存储了界面程序中的信息;用户模型实现文件则给出了模型受仿真程序调用运行时的接口函数模板,包括对应于FMI标准接口中的实例化代码(在模型加载时执行),初始化代码(在模型处于复位状态时执行),步进代码(每次仿真时间推进时执行),重置代码(将模型切换至复位状态时执行),以及终止代码(在模型退出时执行);此外,还根据外部资源及定时任务定义,自动拓展给出了外部资源引用及定时任务处理的接口。用户可以操作界面程序,设置关联的代码编辑工具,在界面程序中可调用代码编辑工具,填写接口函数模板,即可完成模型代码内容的实现。

Step-3:用户可操作界面程序,调用编译构建工具,完成编译过程。界面程序生成FMU构建脚本(典型的如Makefile或CMakeLists.txt)以及S-Function构建脚本(MATLAB语言);FMU构建脚本以及S-Function构建脚本均支持多个模型的批处理操作,界面程序在启动编译操作前,提示用户选择当前需要操作的模型。编译过程中,编译构建工具调用接口程序,根据用户模型定义文件中的接口数据定义,查询公用数据结构定义文件中的已有模型接口数据结构;接口程序递归地解析用户模型定义文件中的接口数据定义,建立已有模型接口数据结构与FMI中所需的一维展开的接口变量间的映射关系,从而能够自动填写FMI接口代码模板、FMI描述文件模板,生成FMU模型对应的FMI接口代码文件以及FMU描述文件。同样的信息也用于自动生成S-Function模型对应的LCT接口代码文件以及LCT模型定义文件。

Step-4:用户可操作界面程序,调用编译构建工具,完成构建过程。构建过程中,编译构建工具首先调用系统管理工具,创建或清理出FMU模型目录结构;然后,调用C/C++编译环境,完成FMU模型对应的FMI接口代码文件、FMI标准通用文件(包含适应多种系统环境的代码,不需要用户修改)与用户模型实现文件的编译与链接,生成FMU动态链接库(在不同系统环境下生成对应版本的文件,如.dll/.so/dynlib等,支持多文件共存),并将过程中可能的调试信息提示给用户;之后,将FMU模型所需的FMU动态链接库、FMU描述文件、FMU资源文件以及FMU源代码文件等汇集到FMU模型目录结构中,完成压缩打包工作;最后,调用FMI测试工具,尝试仿真所生成的FMU模型文件,将测试运行结果打印反馈给用户。

Step-5:用户可以启动MATLAB软件(需要带有LCT模块并配置了C/C++编译环境),执行所生成的S-Function构建脚本,能够根据已生成的LCT接口代码文件以及LCT模型定义文件,创建S-Function动态链接库、总线定义文件、Simulink模块以及Target Link Compiler, TLC脚本文件。

_images/workflow.svg

系统架构及工作流程

详细目录结构

MASTERSIMULATOR WITH MILESTONE 1.0   <<-------- MasterSim根目录
│  MasterSimulator.exe      <<-------- MasterSim 求解器
│  MasterSimulatorUI.exe    <<-------- MasterSim 主界面
│  ...
│
├─Milestone             <<-------- Milestone根目录
│  │  CMakeLists.txt        <<-------- Milestone FMU构建脚本
│  │  Readme.txt            <<-------- Milestone 快速使用指南
│  │  SFcnLists.m           <<-------- Milestone S函数构建脚本
│  │
│  ├─bin
│  │      milestone         <<-------- Milestone 核心程序 (Linux)
│  │      milestone.exe     <<-------- Milestone 核心程序 (Windows)
│  │      ...
│  │
│  ├─export
│  │  │  fmu_controller.fmu <<-------- 导出的模型FMU文件
│  │  │  fmu_plant.fmu
│  │  │  fmu_plant_1.fmu
│  │  │
│  │  └─mastersim           <<-------- MasterSim 测试工程目录
│  │      │  sim.bm
│  │      │  sim.msim
│  │      │
│  │      └─sim
│  │          └─results
│  │                  values.csv    <<-------- MasterSim 测试数据
│  │
│  ├─include                <<-------- FMI标准头文件、模板文件
│  │
│  ├─license
│  │      00-0C-29-19-A4-33.lic     <<-------- 单机授权文件
│  │      00-0C-29-7E-DB-12.lic
│  │      ...
│  │
│  └─model                  <<-------- 模型目录
│      │  interface.h               <<-------- 全局接口头文件
│      │
│      ├─controller                 <<-------- 示例模型:控制器
│      │  ├─resources               <<-------- 示例模型数据文件
│      │  │      init_config.txt
│      │  │      init_data.dat
│      │  │
│      │  └─sources
│      │          controller.cpp    <<-------- 示例模型代码文件
│      │          controller.h      <<-------- 示例模型头文件
│      │
│      ├─plant                      <<-------- 示例模型:被控对象
│      │  └─sources
│      │          plant.cpp
│      │          plant.h
│      │
│      └─plant_1                    <<-------- 示例模型:被控对象1
│          └─sources
│                  plant_1.cpp
│                  plant_1.h
│
├─...