CN113495577A - 一种面向数字孪生仿真的无人机集群传感器模型校正方法 - Google Patents

一种面向数字孪生仿真的无人机集群传感器模型校正方法 Download PDF

Info

Publication number
CN113495577A
CN113495577A CN202111041323.1A CN202111041323A CN113495577A CN 113495577 A CN113495577 A CN 113495577A CN 202111041323 A CN202111041323 A CN 202111041323A CN 113495577 A CN113495577 A CN 113495577A
Authority
CN
China
Prior art keywords
sensor
unmanned aerial
aerial vehicle
model
state
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202111041323.1A
Other languages
English (en)
Other versions
CN113495577B (zh
Inventor
雷磊
李志林
宋晓勤
蔡圣所
张莉涓
朱晓浪
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN202111041323.1A priority Critical patent/CN113495577B/zh
Publication of CN113495577A publication Critical patent/CN113495577A/zh
Application granted granted Critical
Publication of CN113495577B publication Critical patent/CN113495577B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • G05D1/104Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Management, Administration, Business Operations System, And Electronic Commerce (AREA)

Abstract

本发明公开了一种面向数字孪生仿真的无人机集群传感器模型校正方法,该方法属于系统建模与仿真领域,可以有效提高数字孪生模型的准确性和可信度。该方法首先建立面向数字孪生仿真的无人机集群传感器校正模型,包含真实无人机传感器、传感器孪生仿真模型、孪生数据库、无人机集群任务和连接;然后建立基于随机有限集的传感器测量模型,考虑漏检和杂波,求解传感器似然函数;其次,建立基于随机有限集的无人机集群数字孪生仿真模型,考虑集群中无人机的动态加入、离开、衍生和被击毁,求解传感器的马尔科夫状态转移密度函数;最后基于贝叶斯估计方法,求解参数矢量的后验概率密度函数,并通过最大后验估计方法计算参数矢量的校正值。

Description

一种面向数字孪生仿真的无人机集群传感器模型校正方法
技术领域
本发明属于系统建模与仿真领域,特别涉及一种面向数字孪生仿真的无人机集群传感器模型虚实结合校正方法。
背景技术
随着电子机械系统、传感器和通信技术的快速发展,无人机(Unmanned AerialVehicle, UAV)系统因其通用、灵活、易安装和低成本,为军事和民用应用提供了新的途径,如目标搜索和摧毁、边境监视、野火管理、灾害监测和遥感监测。无人机集群是由大量小型无人机组成的群体化、智能化和功能分布化的高抗毁飞行体系,在数量规模、协同效能、敌我对抗交换成本等方面具有巨大的优势,成为了军事科技领域研究的热点。
无人机集群作战效能很大程度上取决于高效的网络架构和集群智能协同控制水平。面对日益复杂的战场电磁环境,空域、时域、频域上种类繁杂、密集重叠、动态多变、功率分布参差不齐的电磁信号对集群协同能力和电磁作战效能的发挥以及战场生存等造成了重要影响和制约作用。如何有效验证无人机集群的组网性能和协同控制能力,提供真实可靠的验证结果,是研究智能化战术战法、规划新型作战力量编制体制、把握未来战争演进趋势的重要手段。
对于无人机集群的组网和协同性能测试,常用的测试方法为测试床试验、数值模拟和半实物仿真。测试床试验通过研制与实际系统相似的实体模型,对其性能测试以评估原系统工作性能,测试结果真实可信,但测试过程风险大,成本高,场景难以再现。数值模拟通过严格的数学模型,利用数值计算软件进行计算分析,测试时间少,测试成本小,利于进行变量控制试验,但难以对非线性行为和不确定因素进行准确建模。半实物仿真在计算机实现仿真模型的基础上,通过加载实际的设备,实现仿真模型与实际设备联合仿真,仿真系统的部分是实际系统的组成部分,其他部分则采用计算机模拟的仿真模型。
近年来,数字孪生(DigitalTwin)备受学术界和企业界关注,尤其是数字孪生的落地应用更是关注热点。数字孪生以数字化方式创建物理实体的虚拟模型,借助数据模拟物理实体在现实环境中的行为,通过虚实交互反馈、数据融合分析、决策迭代优化等手段,为物理实体增加或扩展新的能力。数字孪生充分利用模型、数据、智能并集成多学科的技术,发挥连接物理世界和信息世界的桥梁和纽带作用,提供更加实时、高效、智能的服务。
数字孪生仿真系统实现了真实物理试验与虚拟仿真试验之间的互利共生和深度结合,真实物理试验可以对虚拟仿真试验的预测分析和评估功能进行利用,而虚拟仿真试验利用真实物理试验的数据来提高自身准确性和可信度,同时为真实物理试验提供试验设计、状态预测、结果分析、效能评估、过程控制、和辅助决策等功能支持。数字孪生落地应用的首要任务是创建应用对象的数字孪生模型。无人机通常搭载多种传感器,如三轴加速度计、三轴陀螺仪、三轴磁力计、全球定位系统(GlobalPositioningSystem, GPS)、气压计,利用这些传感器,无人机可以感知自身的位置和姿态,是进一步完成分布式组网与协同任务的前提。因此,如何利用真实无人机传感器的测量数据,构建精确和可信的传感器数字孪生模型,是构建无人机集群数字孪生仿真系统的重要基础。
发明内容
本发明的目的是针对无人机集群数字孪生仿真系统,提出一种虚实结合的传感器模型校正方法。为了实现该目的,本发明公开了一种面向数字孪生仿真的无人机集群传感器模型校正方法,所采用的步骤是:
步骤1:建立面向数字孪生仿真的无人机集群传感器虚实结合校正模型;该模型包含真实无人机传感器、传感器数字孪生仿真模型、数字孪生数据库、无人机集群任务四个模块及其连接;地面站通过无线链路向集群无人机发布任务指令和航点信息,无人机传感器实时采集自身的位置和姿态测量数据,并通过无线链路回传至地面站;地面站通过数据报套接字将测量数据发给仿真引擎,并存储在仿真引擎负责维护的数字孪生数据库,得到测量空间Z;仿真引擎运行传感器数字孪生仿真模型和虚实结合校正模型,运行仿真模型得到传感器状态空间X并存储在数字孪生数据库,然后将测量空间中的测量数据和状态空间中的状态数据输入虚实结合校正模型;
在该模型中:
(1)、所有无人机的同类传感器数字孪生模型在k时刻状态的状态集为X s,k ={xs(1), xs(2), …, xs(n k )},其中s代表单架无人机传感器系统中的第s个传感器,n k 为无人机数量,xs(n k )表示第n k 架无人机、第s个传感器在k时刻的状态矢量,n k 和xs(n k )均为随机变量;不失一般性,针对无人机集群中同一类型传感器进行建模,将传感器s的状态集X s,k 简记为X k ={x(1), x(2), …, x(n k )}={x(i) | i =1, 2,…, n k },状态空间X ={X k | k = 1,2,…};
(2)、每个测量数据最多由一架无人机生成,每架无人机的传感器要么生成一个测量数据,要么不产生测量数据;考虑虚警过程,即杂波过程,与无人机传感器生成测量数据过程独立,并且所有测量数据都条件独立于无人机的状态;k时刻传感器测量数据的测量集为Z k ={z(0), z(1), …, z(m k )}={z(j) | j = 0, 1, 2,…, m k },m k 为测量数据集合在k时刻的元素个数,m k =0时表示空观测,m k 和z(m k )均为随机变量,测量空间Z={Z k |k=1,2,…};
步骤2:建立无人机集群传感器数字孪生测量模型,考虑检测概率为p D(x(i),θ)的伯努利测量模型和独立同分布的泊松杂波模型C k ,求解传感器在k时刻的似然函数g k (Z k |X k , θ),其中θ为数字孪生仿真传感器模型的参数矢量θ,X k 为状态集,Z k 为测量集,x(i)是X k 中第i个元素;
步骤3:建立无人机集群数字孪生仿真模型,考虑集群中无人机的动态加入、离开、衍生和被击毁,求解传感器在k时刻的马尔科夫状态转移密度函数f k|k-1(X k |X k-1,θ);
步骤4:基于贝叶斯估计方法,通过传感器测量集和状态集,并结合测量模型和数字孪生仿真模型,求解状态集依条件于测量集的预测和校正的后验概率密度函数,然后求解参数矢量的后验概率密度函数,并通过最大后验估计方法计算参数矢量θ的校正值
Figure 521089DEST_PATH_IMAGE001
进一步,建立基于随机有限集的传感器测量模型,求解传感器的似然函数的具体方法为:
(1)、一个传感器测量模型对应一个似然函数g k (z(j)|x(i),θ),该传感器对无人机的位置和姿态状态进行观测,不同无人机的传感器将测量数据将经过地面站转发汇总到数字孪生数据库;θ表示参数矢量,包含传感器偏差和噪声的参数;
(2)、对于单架无人机的状态x(i),传感器的检测概率为p D(x(i),θ),生成一个测量数据;漏检概率为1-p D(x(i),θ),即不产生测量数据;
(3)、杂波过程C k 在时间上服从期望值为λ C的泊松分布,其空间分布服从概率密度函数c(z(j),θ);时间和空间分布表示在一段时间内、一定区域内杂波数量的分布情况;
考虑传感器测量过程中的漏检和杂波,则传感器的随机观测数据集合Z k 表示为
Figure 387414DEST_PATH_IMAGE002
(1)
其中,T k (X k )为状态X k 生成的测量数据,T k (x(i))为状态x(i)对应的无人机传感器生成的测量数据集;
假设一个无人机实体或者生成一个测量数据,或者没有生成测量数据,T k (x(i))具有如下形式
Figure 522860DEST_PATH_IMAGE003
(2)
其中,集合A∈Z,Z(x(i))为与x(i)有关的传感器测量模型的输出状态;
传感器测量过程的不确定性p b(A=G),A、G∈Z,用伯努利测量模型描述为
Figure 132833DEST_PATH_IMAGE004
(3)
假设杂波过程C k 为{c1,…,c M },M=|c k |为随机非负整数,若C k 为泊松过程,则M的概率分布为
Figure 37335DEST_PATH_IMAGE005
(4)
对于状态集合X k ,它生成测量数据集合Z k 的概率密度函数通过似然函数g k (Z k |X k ,θ)描述;综合考虑传感器输出、杂波和噪声的影响,似然函数g k (Z k |X k , θ)计算为
Figure 74561DEST_PATH_IMAGE006
(5)
其中φ(i)是状态集X k 元素下标{1, 2,…, n k }到测量集Z k 元素下标{0, 1, 2,…,m k }的关联函数,φ={φ(i)}表示所有关联函数的集合。
进一步,建立基于随机有限集的无人机集群数字孪生仿真模型,求解传感器的马尔科夫状态转移密度函数的具体方法为:
在无人机集群执行任务过程中,无人机动态加入和离开,以及受到火力打击而被击毁,使得无人机的数目在不断变化;无人机实体的动态演化可以通过基于随机有限集的无人机集群数字孪生仿真模型来描述:
(1)、单个传感器的数字孪生仿真模型采用加性模型:X k =H(X k-1)+U k-1+V k-1,U k-1和V k-1分别表示k-1时刻传感器偏差和噪声,对应的马尔科夫状态转移密度函数为f k|k-1(x(n k )|x(n k-1),θ),表示k-1时刻状态为x(n k-1)的传感器在k时刻状态为x(n k )的可能性;θ表示参数矢量,包含传感器偏差和噪声的参数;
(2)、k-1时刻状态为x(n k-1)的传感器所在无人机存活至k时刻的概率简记为p S(x(n k ),θ);
(3)、k-1时刻状态为x(n k-1)的传感器所在无人机在k时刻衍生出新的无人机的概率为y k|k-1(Y k|k-1(X k-1)|x(n k-1),θ),其中Y k|k-1(X k-1)为衍生无人机传感器的状态集合;k时刻的新生无人机对应传感器的状态集合等于Y k 的概率密度函数为y k (Y k ,θ);
(4)、k时刻无人机实体持续存在的状态集合为S k|k-1(X k-1),其中X k-1={x′(1),x′(2),…,x′(n k-1)};
无人机集群传感器数字孪生仿真模型的马尔科夫状态转移密度函数f k|k-1(X k |X k-1,θ)可以表示为
Figure 431724DEST_PATH_IMAGE007
(6)
式(6)中
Figure 845388DEST_PATH_IMAGE008
(7)
其中,u 0(θ)是初始时刻无人机的期望数目,y 0(x(i),θ)是其状态分布,u(x′(i),θ)是由状态x′(i)衍生出的新无人机的期望数目,y(x(i)|x′(i),θ)是其状态分布;
Figure 463451DEST_PATH_IMAGE009
k-1时刻状态矢量x′(i)的元素下标{1, 2,…, n k-1}到k时刻状态矢量x(i)的元素下标{1,2,…, n k }的关联函数,
Figure 316918DEST_PATH_IMAGE010
表示所有关联函数的集合。
进一步,求解参数矢量的后验概率密度函数,并计算参数矢量的校正值的具体方法为:
令Z1:k ={Z1,…,Z k }表示传感器测量数据的时间序列,用l k|k (X k |Z1:k ,θ)表示无人机集群在k时刻状态的后验概率密度函数;假设k-1时刻的后验概率密度函数l k-1|k-1(X k-1|Z1:k-1,θ)已知,并得到k时刻累积的测量数据Z1:k ,则根据贝叶斯估计方法,得到预测和校正的后验概率密度函数分别为
Figure 286012DEST_PATH_IMAGE011
(8)
Figure 113153DEST_PATH_IMAGE012
(9)
面向数字孪生仿真的无人机集群传感器校正的目的是得到后验概率密度函数p(θ|Z1:k ),在拥有先验信息p 0(θ)的前提下,应用贝叶斯推理方法得到
Figure 851302DEST_PATH_IMAGE013
(10)
其中概率密度函数p(Z1:k |θ)计算为
Figure 371276DEST_PATH_IMAGE014
(11)
最后,使用后验概率密度函数p(θ|Z1:k )的均值,并通过最大后验估计方法计算参数矢量θ的校正值
Figure 827665DEST_PATH_IMAGE001
Figure 458498DEST_PATH_IMAGE015
(12)。
附图说明
图1是本发明的面向数字孪生仿真的无人机集群传感器校正模型;
图2是本发明的无人机集群传感器数字孪生测量模型;
图3是本发明的无人机集群数字孪生仿真模型。
具体实施方式
下面结合附图和实施例对本发明作进一步详细描述。
本发明提出了一种面向数字孪生仿真的无人机集群传感器模型校正方法,具体实施步骤为:
步骤1:建立面向数字孪生仿真的无人机集群传感器虚实结合校正模型。
如附图1所示,该模型包含真实无人机传感器、传感器数字孪生仿真模型、数字孪生数据库、无人机集群任务四个模块及其连接;地面站通过无线链路向集群无人机发布任务指令和航点信息,无人机传感器实时采集自身的位置和姿态测量数据,并通过无线链路回传至地面站;地面站通过数据报套接字将测量数据发给仿真引擎,并存储在仿真引擎负责维护的数字孪生数据库,得到测量空间Z;仿真引擎运行传感器数字孪生仿真模型和虚实结合校正模型,运行仿真模型得到传感器状态空间X并存储在数字孪生数据库,然后将测量空间中的测量数据和状态空间中的状态数据输入虚实结合校正模型。
在该模型中:
(1)所有无人机的同类传感器数字孪生模型在k时刻状态的状态集为X s,k ={xs(1),xs(2), …, xs(n k )},其中s代表单架无人机传感器系统中的第s个传感器,n k 为无人机数量,xs(n k )表示第n k 架无人机、第s个传感器在k时刻的状态矢量,n k 和xs(n k )均为随机变量。状态xs(n k )的具体含义根据传感器s而定,表1列举了旋翼无人机基本的位置和姿态传感器,其中xy、z表示三维坐标轴,每架无人机根据自身位置和姿态传感器的输出,通过飞控算法解算出无人机最终的飞行位置和姿态。
表1 旋翼无人机位置和姿态传感器输出状态
Figure 785574DEST_PATH_IMAGE016
不失一般性,针对无人机集群中同一类型传感器进行建模,将传感器s的状态集X s,k 简记为X k ={x(1), x(2), …, x(n k )}={x(i) | i =1, 2,…, n k },状态空间X ={X k | k = 1, 2,…}。
(2)每个测量数据最多由一架无人机生成,每架无人机的传感器要么生成一个测量数据,要么不产生测量数据。考虑虚警过程,即杂波过程,与无人机传感器生成测量数据过程独立,并且所有测量数据都条件独立于无人机的状态。k时刻传感器测量数据的测量集为Z k ={z(0), z(1), …, z(m k )}={z(j) | j = 0, 1, 2,…, m k },m k 为测量数据集合在k时刻的元素个数,m k =0时表示空观测,m k 和z(m k )均为随机变量,测量空间Z={Z k |k=1,2,…}。
步骤2:建立无人机集群传感器数字孪生测量模型,考虑检测概率为p D(x(i),θ)的伯努利测量模型和独立同分布的泊松杂波模型C k ,求解传感器在k时刻的似然函数g k (Z k |X k , θ),其中θ为数字孪生仿真传感器模型的参数矢量θ,X k 为状态集,Z k 为测量集,x(i)是X k 中第i个元素。
(1)一个传感器测量模型对应一个似然函数g k (z(j)|x(i),θ),该传感器对无人机的位置和姿态状态进行观测,不同无人机的传感器将测量数据将经过地面站转发汇总到数字孪生数据库。θ表示参数矢量,包含传感器偏差和噪声的参数。
(2)对于单架无人机的状态x(i),传感器的检测概率为p D(x(i),θ),生成一个测量数据;漏检概率为1-p D(x(i),θ),即不产生测量数据。
(3)杂波过程C k 在时间上服从期望值为λ C的泊松分布,其空间分布服从概率密度函数c(z(j),θ)。时间和空间分布表示在一段时间内、一定区域内杂波数量的分布情况。
考虑传感器测量过程中的漏检、虚警或杂波,建立如附图2所示的无人机集群传感器数字孪生测量模型。该模型集成了传感器的噪声模型,而且还可以描述传感器的检测概率、杂波和数据传输噪声,则传感器的随机观测数据集合Z k 表示为
Figure 601083DEST_PATH_IMAGE002
(1)
其中,T k (X k )为状态X k 生成的测量数据,T k (x(i))为状态x(i)对应的无人机传感器生成的测量数据集。
假设一个无人机实体或者生成一个测量数据,或者没有生成测量数据,T k (x(i))具有如下形式
Figure 918670DEST_PATH_IMAGE003
(2)
其中,集合A∈Z,Z(x(i))为与x(i)有关的传感器测量模型的输出状态。
传感器测量过程的不确定性p b(A=G),A、G∈Z,用伯努利测量模型描述为
Figure 212248DEST_PATH_IMAGE004
(3)
假设杂波过程C k 为{c1,…,c M },M=|c k |为随机非负整数,若C k 为泊松过程,则M的概率分布为
Figure 800355DEST_PATH_IMAGE005
(4)
对于状态集合X k ,它生成测量数据集合Z k 的概率密度函数通过似然函数g k (Z k |X k ,θ)描述。综合考虑传感器输出、杂波和噪声的影响,似然函数g k (Z k |X k , θ)计算为
Figure 521187DEST_PATH_IMAGE006
(5)
其中φ(i)是状态集X k 元素下标{1, 2,…, n k }到测量集Z k 元素下标{0,1, 2,…,m k }的关联函数,φ={φ(i)}表示所有关联函数的集合。
步骤3:建立无人机集群数字孪生仿真模型,考虑集群中无人机的动态加入、离开、衍生和被击毁,求解传感器在k时刻的马尔科夫状态转移密度函数f k|k-1(X k |X k-1,θ)。
在无人机集群执行任务过程中,无人机动态加入和离开,以及受到火力打击而被击毁,使得无人机的数目在不断变化。如附图3所示,无人机实体的动态演化可以通过无人机集群数字孪生仿真模型来描述。
(1)单个传感器的数字孪生仿真模型采用加性模型:X k =H(X k-1)+U k-1+V k-1,U k-1和V k-1分别表示k-1时刻传感器偏差和噪声,对应的马尔科夫状态转移密度函数为f k|k-1(x(n k )|x(n k-1),θ),表示k-1时刻状态为x(n k-1)的传感器在k时刻状态为x(n k )的可能性。θ表示参数矢量,包含传感器偏差和噪声的参数。
(2)k-1时刻状态为x(n k-1)的传感器所在无人机存活至k时刻的概率简记为p S(x(n k ),θ)。
(3)k-1时刻状态为x(n k-1)的传感器所在无人机在k时刻衍生出新的无人机的概率为y k|k-1(Y k|k-1(X k-1)|x(n k-1),θ),其中Y k|k-1(X k-1)为衍生无人机传感器的状态集合。k时刻的新生无人机对应传感器的状态集合等于Y k 的概率密度函数为y k (Y k ,θ)。
(4)k时刻无人机实体持续存在的状态集合为S k|k-1(X k-1),其中X k-1={x′(1),x′(2),…,x′(n k-1)}。
无人机集群传感器数字孪生仿真模型的马尔科夫状态转移密度函数f k|k-1(X k |X k-1,θ)可以表示为
Figure 827534DEST_PATH_IMAGE007
(6)
式(6)中
Figure 659224DEST_PATH_IMAGE008
(7)
其中,u 0(θ)是初始时刻无人机的期望数目,y 0(x(i),θ)是其状态分布,u(x′(i),θ)是由状态x′(i)衍生出的新无人机的期望数目,y(x(i)|x′(i),θ)是其状态分布。
Figure 492051DEST_PATH_IMAGE009
k-1时刻状态矢量x′(i)的元素下标{1, 2,…, n k-1}到k时刻状态矢量x(i)的元素下标{1,2,…, n k }的关联函数,
Figure 259150DEST_PATH_IMAGE010
表示所有关联函数的集合。
步骤4:基于贝叶斯估计方法,通过传感器测量集和状态集,并结合测量模型和数字孪生仿真模型,求解状态集依条件于测量集的预测和校正的后验概率密度函数l k|k-1(X k |Z1:k-1,θ)和l k|k (X k |Z1:k ,θ),然后求解参数矢量的后验概率密度函数p(θ|Z1:k ),并通过最大后验估计方法计算参数矢量θ的校正值
Figure 911848DEST_PATH_IMAGE017
令Z1:k ={Z1,…,Z k }表示传感器测量数据的时间序列,用l k|k (X k |Z1:k ,θ)表示无人机集群在k时刻状态的后验概率密度函数。假设k-1时刻的后验概率密度函数l k-1|k-1(X k-1|Z1:k-1,θ)已知,并得到k时刻累积的测量数据Z1:k ,则根据贝叶斯估计方法,并结合步骤2和步骤3得到的传感器测量模型和无人机数字孪生仿真模型,得到预测和校正的后验概率密度函数分别为
Figure 186709DEST_PATH_IMAGE011
(8)
Figure 608463DEST_PATH_IMAGE012
(9)
面向数字孪生仿真的无人机集群传感器校正的目的是得到后验概率密度函数p(θ|Z1:k ),在拥有先验信息p 0(θ)的前提下,应用贝叶斯推理方法得到
Figure 812043DEST_PATH_IMAGE013
(10)
其中概率密度函数p(Z1:k |θ)计算为
Figure 952037DEST_PATH_IMAGE014
(11)
最后,使用后验概率密度函数p(θ|Z1:k )的均值,并通过最大后验估计方法计算参数矢量θ的校正值
Figure 391109DEST_PATH_IMAGE017
Figure 808315DEST_PATH_IMAGE015
(12)
本发明中未作详细描述的内容属于本领域专业技术人员公知的现有技术。

Claims (4)

1.一种面向数字孪生仿真的无人机集群传感器模型校正方法,其特征在于,所采用的步骤是:
步骤1:建立面向数字孪生仿真的无人机集群传感器虚实结合校正模型;该模型包含真实无人机传感器、传感器数字孪生仿真模型、数字孪生数据库、无人机集群任务四个模块及其连接;地面站通过无线链路向集群无人机发布任务指令和航点信息,无人机传感器实时采集自身的位置和姿态测量数据,并通过无线链路回传至地面站;地面站通过数据报套接字将测量数据发给仿真引擎,并存储在仿真引擎负责维护的数字孪生数据库,得到测量空间Z;仿真引擎运行传感器数字孪生仿真模型和虚实结合校正模型,运行仿真模型得到传感器状态空间X并存储在数字孪生数据库,然后将测量空间中的测量数据和状态空间中的状态数据输入虚实结合校正模型;
在该模型中:
(1)、所有无人机的同类传感器数字孪生模型在k时刻状态的状态集为X s,k ={xs(1), xs(2), …, xs(n k )},其中s代表单架无人机传感器系统中的第s个传感器,n k 为无人机数量,xs(n k )表示第n k 架无人机、第s个传感器在k时刻的状态矢量,n k 和xs(n k )均为随机变量;不失一般性,针对无人机集群中同一类型传感器进行建模,将传感器s的状态集X s,k 简记为X k ={x(1), x(2), …, x(n k )}={x(i) | i =1, 2,…, n k },状态空间X ={X k | k = 1, 2,…};
(2)、每个测量数据最多由一架无人机生成,每架无人机的传感器要么生成一个测量数据,要么不产生测量数据;考虑虚警过程,即杂波过程,与无人机传感器生成测量数据过程独立,并且所有测量数据都条件独立于无人机的状态;k时刻传感器测量数据的测量集为Z k ={z(0), z(1), …, z(m k )}={z(j) | j = 0, 1, 2,…, m k },m k 为测量数据集合在k时刻的元素个数,m k =0时表示空观测,m k 和z(m k )均为随机变量,测量空间Z={Z k |k=1,2,…};
步骤2:建立无人机集群传感器数字孪生测量模型,考虑检测概率为p D(x(i),θ)的伯努利测量模型和独立同分布的泊松杂波模型C k ,求解传感器在k时刻的似然函数g k (Z k |X k ,θ),其中θ为数字孪生仿真传感器模型的参数矢量θ,X k 为状态集,Z k 为测量集,x(i)是X k 中第i个元素;
步骤3:建立无人机集群数字孪生仿真模型,考虑集群中无人机的动态加入、离开、衍生和被击毁,求解传感器在k时刻的马尔科夫状态转移密度函数f k|k-1(X k |X k-1,θ);
步骤4:基于贝叶斯估计方法,通过传感器测量集和状态集,并结合测量模型和数字孪生仿真模型,求解状态集依条件于测量集的预测和校正的后验概率密度函数,然后求解参数矢量的后验概率密度函数,并通过最大后验估计方法计算参数矢量θ的校正值
Figure 792309DEST_PATH_IMAGE001
2.根据权利要求1所述的一种面向数字孪生仿真的无人机集群传感器模型校正方法,其特征在于,建立无人机集群传感器数字孪生测量模型,求解传感器的似然函数的具体方法为:
(1)、一个传感器测量模型对应一个似然函数g k (z(j)|x(i),θ),该传感器对无人机的位置和姿态状态进行观测,不同无人机的传感器将测量数据将经过地面站转发汇总到数字孪生数据库;θ表示参数矢量,包含传感器偏差和噪声的参数;
(2)、对于单架无人机的状态x(i),传感器的检测概率为p D(x(i),θ),生成一个测量数据;漏检概率为1-p D(x(i),θ),即不产生测量数据;
(3)、杂波过程C k 在时间上服从期望值为λ C的泊松分布,其空间分布服从概率密度函数c(z(j),θ);时间和空间分布表示在一段时间内、一定区域内杂波数量的分布情况;
考虑传感器测量过程中的漏检和杂波,则传感器的随机观测数据集合Z k 表示为
Figure 178291DEST_PATH_IMAGE002
(1)
其中,T k (X k )为状态X k 生成的测量数据,T k (x(i))为状态x(i)对应的无人机传感器生成的测量数据集;
假设一个无人机实体或者生成一个测量数据,或者没有生成测量数据,T k (x(i))具有如下形式
Figure 302236DEST_PATH_IMAGE003
(2)
其中,集合A∈Z,Z(x(i))为与x(i)有关的传感器测量模型的输出状态;
传感器测量过程的不确定性p b(A=G),A、G∈Z,用伯努利测量模型描述为
Figure 166287DEST_PATH_IMAGE004
(3)
假设杂波过程C k 为{c1,…,c M },M=|c k |为随机非负整数,若C k 为泊松过程,则M的概率分布为
Figure 574134DEST_PATH_IMAGE005
(4)
对于状态集合X k ,它生成测量数据集合Z k 的概率密度函数通过似然函数g k (Z k |X k , θ)描述;综合考虑传感器输出、杂波和噪声的影响,似然函数g k (Z k |X k , θ)计算为
Figure 865438DEST_PATH_IMAGE006
(5)
其中φ(i)是状态集X k 元素下标{1, 2,…, n k }到测量集Z k 元素下标{0, 1, 2,…, m k }的关联函数,φ={φ(i)}表示所有关联函数的集合。
3.根据权利要求2所述的一种面向数字孪生仿真的无人机集群传感器模型校正方法,其特征在于,建立无人机集群数字孪生仿真模型,求解传感器的马尔科夫状态转移密度函数的具体方法为:
在无人机集群执行任务过程中,无人机动态加入和离开,以及受到火力打击而被击毁,使得无人机的数目在不断变化;无人机实体的动态演化可以通过无人机集群数字孪生仿真模型来描述:
(1)、单个传感器的数字孪生仿真模型采用加性模型:X k =H(X k-1)+U k-1+V k-1,U k-1和V k-1分别表示k-1时刻传感器偏差和噪声,对应的马尔科夫状态转移密度函数为f k|k-1(x(n k )|x(n k-1),θ),表示k-1时刻状态为x(n k-1)的传感器在k时刻状态为x(n k )的可能性;θ表示参数矢量,包含传感器偏差和噪声的参数;
(2)、k-1时刻状态为x(n k-1)的传感器所在无人机存活至k时刻的概率简记为p S(x(n k ),θ);
(3)、k-1时刻状态为x(n k-1)的传感器所在无人机在k时刻衍生出新的无人机的概率为y k|k-1(Y k|k-1(X k-1)|x(n k-1),θ),其中Y k|k-1(X k-1)为衍生无人机传感器的状态集合;k时刻的新生无人机对应传感器的状态集合等于Y k 的概率密度函数为y k (Y k ,θ);
(4)、k时刻无人机实体持续存在的状态集合为S k|k-1(X k-1),其中X k-1={x′(1),x′(2),…,x′(n k-1)};
无人机集群传感器数字孪生仿真模型的马尔科夫状态转移密度函数f k|k-1(X k |X k-1,θ)可以表示为
Figure 240794DEST_PATH_IMAGE007
(6)
式(6)中
Figure 908535DEST_PATH_IMAGE008
(7)
其中,u 0(θ)是初始时刻无人机的期望数目,y 0(x(i),θ)是其状态分布,u(x′(i),θ)是由状态x′(i)衍生出的新无人机的期望数目,y(x(i)|x′(i),θ)是其状态分布;
Figure 170890DEST_PATH_IMAGE009
k-1时刻状态矢量x′(i)的元素下标{1, 2,…, n k-1}到k时刻状态矢量x(i)的元素下标{1, 2,…,n k }的关联函数,
Figure 633095DEST_PATH_IMAGE010
表示所有关联函数的集合。
4. 根据权利要求3所述的一种面向数字孪生仿真的无人机集群传感器模型校正方法,其特征在于,求解参数矢量的后验概率密度函数,并计算参数矢量的校正值的具体方法为:
令Z1:k ={Z1,…,Z k }表示传感器测量数据的时间序列,用l k|k (X k |Z1:k ,θ)表示无人机集群在k时刻状态的后验概率密度函数;假设k-1时刻的后验概率密度函数l k-1|k-1(X k-1|Z1:k-1,θ)已知,并得到k时刻累积的测量数据Z1:k ,则根据贝叶斯估计方法,得到预测和校正的后验概率密度函数分别为
Figure 731632DEST_PATH_IMAGE011
(8)
Figure 937485DEST_PATH_IMAGE012
(9)
面向数字孪生仿真的无人机集群传感器校正的目的是得到后验概率密度函数p(θ|Z1:k ),在拥有先验信息p 0(θ)的前提下,应用贝叶斯推理方法得到
Figure 54346DEST_PATH_IMAGE013
(10)
其中概率密度函数p(Z1:k |θ)计算为
Figure 218611DEST_PATH_IMAGE014
(11)
最后,使用后验概率密度函数p(θ|Z1:k )的均值,并通过最大后验估计方法计算参数矢量θ的校正值
Figure 929078DEST_PATH_IMAGE001
Figure 52804DEST_PATH_IMAGE015
(12)。
CN202111041323.1A 2021-09-07 2021-09-07 一种面向数字孪生仿真的无人机集群传感器模型校正方法 Active CN113495577B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111041323.1A CN113495577B (zh) 2021-09-07 2021-09-07 一种面向数字孪生仿真的无人机集群传感器模型校正方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111041323.1A CN113495577B (zh) 2021-09-07 2021-09-07 一种面向数字孪生仿真的无人机集群传感器模型校正方法

Publications (2)

Publication Number Publication Date
CN113495577A true CN113495577A (zh) 2021-10-12
CN113495577B CN113495577B (zh) 2021-12-10

Family

ID=77997069

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111041323.1A Active CN113495577B (zh) 2021-09-07 2021-09-07 一种面向数字孪生仿真的无人机集群传感器模型校正方法

Country Status (1)

Country Link
CN (1) CN113495577B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113868898A (zh) * 2021-11-29 2021-12-31 联想新视界(北京)科技有限公司 基于数字孪生模型的数据处理方法及装置
CN117311396A (zh) * 2023-11-30 2023-12-29 中国科学院空天信息创新研究院 飞行监控方法、装置、设备及介质

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110851966A (zh) * 2019-10-30 2020-02-28 同济大学 一种基于深度神经网络的数字孪生模型修正方法
KR20200063889A (ko) * 2018-11-28 2020-06-05 서울대학교산학협력단 디지털 트윈을 이용한 플랜트 운영 방법, 시스템 및 컴퓨터 프로그램
CN112949174A (zh) * 2021-02-24 2021-06-11 刘志欣 数字孪生的构建方法、装置、终端及存储介质
CN112947173A (zh) * 2021-02-03 2021-06-11 北京理工大学 一种数字孪生车间运行状态的预测方法、控制器及系统

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20200063889A (ko) * 2018-11-28 2020-06-05 서울대학교산학협력단 디지털 트윈을 이용한 플랜트 운영 방법, 시스템 및 컴퓨터 프로그램
CN110851966A (zh) * 2019-10-30 2020-02-28 同济大学 一种基于深度神经网络的数字孪生模型修正方法
CN112947173A (zh) * 2021-02-03 2021-06-11 北京理工大学 一种数字孪生车间运行状态的预测方法、控制器及系统
CN112949174A (zh) * 2021-02-24 2021-06-11 刘志欣 数字孪生的构建方法、装置、终端及存储介质

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
PRANAV M. KARVE 等: ""Digital twin approach for damage-tolerant mission planning under"", 《ENGINEERING FRACTURE MECHANICS》 *
王鹏 等: ""面向数字孪生的动态数据驱动建模与仿真方法"", 《系统工程与电子技术》 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113868898A (zh) * 2021-11-29 2021-12-31 联想新视界(北京)科技有限公司 基于数字孪生模型的数据处理方法及装置
CN117311396A (zh) * 2023-11-30 2023-12-29 中国科学院空天信息创新研究院 飞行监控方法、装置、设备及介质
CN117311396B (zh) * 2023-11-30 2024-04-09 中国科学院空天信息创新研究院 飞行监控方法、装置、设备及介质

Also Published As

Publication number Publication date
CN113495577B (zh) 2021-12-10

Similar Documents

Publication Publication Date Title
CN113495577B (zh) 一种面向数字孪生仿真的无人机集群传感器模型校正方法
Xu et al. A survey on digital twin for industrial internet of things: Applications, technologies and tools
Xiang et al. V2xp-asg: Generating adversarial scenes for vehicle-to-everything perception
JP2021039750A (ja) マルチソースのリアルタイムかつコンテキストアウェアな実世界データによる仮想知能および最適化
Goktogan et al. Real time multi-UAV simulator
Oliveira et al. Cooperative terrain navigation using hybrid GMM/SMC message passing on factor graphs
CN117390498B (zh) 一种基于Transformer模型的固定翼集群无人机飞行能力评估方法
Shahrooei et al. Falsification of learning-based controllers through multi-fidelity Bayesian optimization
Yin et al. Reliable global path planning of off-road autonomous ground vehicles under uncertain terrain conditions
Luppen et al. A case study in formal specification and runtime verification of a CubeSat communications system
El Sabbagh et al. Promoting navigation system efficiency during GPS outage via cascaded neural networks: A novel AI based approach
Datar et al. Flocking towards the source: Indoor experiments with quadrotors
Moorthy et al. A Middleware for Digital Twin-Enabled Flying Network Simulations Using UBSim and UB-ANC
Zhang et al. UWB/INS-based robust anchor-free relative positioning scheme for UGVs
Liang et al. Optimization of spatiotemporal clustering for target tracking from multisensor data
Refan et al. RTDGPS implementation by online prediction of GPS position components error using GA-ANN model
Panetta et al. Distributed particle filter with online model learning for localization using time-difference-of-arrival (TDOA) measurements
Ma et al. Mission Capability Evaluation Testing System for Unmanned Aerial Vehicle Swarm
Hu et al. DoDAF and STK Based Modeling and Simulation of MAV/UAV Cooperative Detection Architecture
Jung et al. Weapon Combat Effectiveness Analytics Using Big Data and Simulations: A Literature Review
Konstantinovna Integration of iots security concepts and technical systems diagnostics
Alves et al. Blockchain-enabled redundant fractionated spacecraft system
Beach Mobility modeling and estimation for delay tolerant unmanned ground vehicle networks
Ploder SecUAV-A Uni_ed testbed for the evaluation of secure state estimators
Jha et al. Integration of ROS and Gazebo Platform using MAVLINK Protocol for Real-Time UAV Applications

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant