CN109657928A - 一种车载传感器系统的闭环协同调度框架及调度方法 - Google Patents

一种车载传感器系统的闭环协同调度框架及调度方法 Download PDF

Info

Publication number
CN109657928A
CN109657928A CN201811429564.1A CN201811429564A CN109657928A CN 109657928 A CN109657928 A CN 109657928A CN 201811429564 A CN201811429564 A CN 201811429564A CN 109657928 A CN109657928 A CN 109657928A
Authority
CN
China
Prior art keywords
sensor
observation
matrix
moment
decision
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
CN201811429564.1A
Other languages
English (en)
Other versions
CN109657928B (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.)
Dalian University of Technology
Original Assignee
Dalian University of Technology
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 Dalian University of Technology filed Critical Dalian University of Technology
Priority to CN201811429564.1A priority Critical patent/CN109657928B/zh
Publication of CN109657928A publication Critical patent/CN109657928A/zh
Application granted granted Critical
Publication of CN109657928B publication Critical patent/CN109657928B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06QINFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
    • G06Q10/00Administration; Management
    • G06Q10/06Resources, workflows, human or project management; Enterprise or organisation planning; Enterprise or organisation modelling
    • G06Q10/063Operations research, analysis or management
    • G06Q10/0631Resource planning, allocation, distributing or scheduling for enterprises or organisations
    • G06Q10/06312Adjustment or analysis of established resource schedule, e.g. resource or task levelling, or dynamic rescheduling

Abstract

本发明属于多传感器管理领域,具体涉及一种车载传感器系统的闭环协同调度框架及调度方法。所述的闭环协同调度框架,包括传感器集合层、决策层和融合层;传感器集合层表示异构的传感器资源集合。融合层结合环境因素以及传感器的观测数据,对目标进行状态估计以及下一个时刻的状态预测,并生成相应的目标态势图像。决策层利用融合层提供的数据信息以及目标态势图像,进行平台路径规划,产生的环境观测需求传递给车载传感器系统。决策层根据平台路径规划结果产生传感器的调度命令,指导传感器集合进行动作更新,实现复杂多变的环境下多传感器的精确探测和追踪。本发明实现传感器资源的高效分配,最终实现多传感器探测、目标追踪的风险最小化。

Description

一种车载传感器系统的闭环协同调度框架及调度方法
技术领域
本发明属于多传感器管理领域,具体涉及一种车载传感器系统的闭环协同调度框架及调度方法。
背景技术
进入20世纪70年代以后,多传感器系统大量涌现。相对于单传感器,多传感器系统可以获得更多、更精确的观测信息。20世纪中后期,多传感器系统结合不同的平台形成车载传感器平台,并开始广泛应用于目标跟踪领域。由于环境的多变性、目标状态变化的不确定,需要对多传感器进行合理的配置以实现对目标的精确、稳定追踪,多传感器管理的研究因此受到更广泛的关注。合理有效的传感器管理策略一方面能够实现对传感器资源最有效的利用,另一方面也可以减轻操作员负担,最终实现目标跟踪任务的效能最大化。
目标跟踪是指通过对传感器的观测信息进行融合,得到目标的状态估计并对目标进行下一个时刻状态预测,这些估计以及预测信息通过人机交互界面呈现为目标的态势图像,并用于指导平台路径规划,从而实现对目标的精确定位与追踪。传感器通过对当前环境的观测给出合适的调度方案,进行目标识别、分类随着多传感器系统应用的场景越来越复杂化,数据融合得到的目标状态图像很快失效,转瞬即逝以及不易辨别的目标需要传感器调度具有更大的灵活性。传统的车载传感器系统采用开环的调度方法,即平台路径规划后产生的新环境观测需求无法传递给传感器系统,从而降低了传感器观测的精度以及反应速度,增大了目标追踪的误差及风险性。
鉴于传统车载传感器资源管理的低效以及高风险性,本发明提出一种车载传感器系统的闭环协同调度模型。通过加入反馈控制形成回路,将平台路径规划后引起的环境观测需求及时反馈给传感器系统,传感器系统应用基于风险的调度算法给出最佳调度方案,实现对目标的精确探测。传感器的观测信息进而通过数据融合中心转化为目标的态势图像用于平台路径规划。这个过程循环下去,从而使得数据融合的信息更加全面,平台路径规划更加准确,传感器调度决策更加灵活,最终实现复杂多变的环境下多传感器探测及目标追踪的风险最小化。
发明内容
本发明所要解决的技术问题是通过构建车载传感器系统的闭环协同调度模型,以实现传感器资源的高效分配,最终实现多传感器探测、目标追踪的风险最小化。本发明构建了车载传感器系统的闭环协同调度框架,提出实现闭环协同调度的关键技术,最后给出基于闭环调度框架的传感器调度方法。
为了达到上述目的,本发明的技术方案如下:
一种车载传感器系统的闭环协同调度框架,如图1所示,包括传感器集合层、决策层和融合层;传感器集合层表示异构的传感器资源集合,传感器包括雷达、红外传感器和成像传感器。雷达、红外传感器和成像传感器执行决策层的命令,并产生各种类型的观测数据。
车载传感器系统在工作环境中运作,工作环境包括被跟踪目标本身及影响其行为、表现和结果的环境因素。融合层结合环境因素以及传感器的观测数据,对目标进行状态估计以及下一个时刻的状态预测,并生成相应的目标态势图像。决策层利用融合层提供的数据信息以及目标态势图像,进行平台路径规划,产生的环境观测需求传递给车载传感器系统。决策层根据平台路径规划结果产生传感器的调度命令,指导传感器集合进行动作更新,实现复杂多变的环境下多传感器的精确探测和追踪。反馈回路持续进行,传感器观测数据在决策层、传感器集合层和融合层之间进行循环传输,以提升传感器观测的精度以及反应速度,降低目标追踪的误差及风险性。
一种车载传感器系统的闭环协同调度方法,该方法采用马尔科夫决策过程,主要包括两个步骤,第一步是根据目标状态信息进行平台路径规划,第二步是根据路径规划后产生的状态改变进行传感器调度决策。
第一步:平台路径规划
决策层的PRM采用传感器集合层的观测数据以及融合层的融合结果进行平台路径规划。
平台路径规划构建基于奖励函数的目标函数,采用Fisher信息矩阵进行目标状态以及协方差的更新,通过最大化时间k处观测产生的N步时间步长上累积的信息增益规划平台下一时刻的运动轨迹,并通过对应每个目标的主观优先级因子和时间折扣因子来缩放信息增益表示准确性的衰减。
步骤1:融合层计算时刻k传感器观测前的期望Fisher信息矩阵
时刻k观测前的Fisher信息矩阵需要根据时刻k-1的目标状态进行预测,如式(2)所示:
其中πj(k)表示时刻k轨道j的观测概率,Pj(k|k-1)表示轨道协方差。
对于真实轨道,轨道概率以及协方差由融合层的MHT直接给出,对于伪轨道,πj(k)计算公式如式(1)所示,Pj(k|k-1)通过人为输入得到,使得其3-σ误差椭圆处于预期的搜索单元内,σ为标准差常数。
其中πD(k,s,j)是传感器s在时刻k处检测伪轨道j的概率,由传感器观测层给出。
步骤2:融合层计算时刻k传感器观测之后得到的期望更新Fisher信息矩阵
传感器观测后的Fisher信息矩阵由轨道观测概率、观测矩阵以及观测噪声协方差矩阵得到,如式(3)所示:
其中πj(k)表示时刻k轨道j的观测概率,πD(k,s,j)是传感器s在时刻k处检测伪轨道j的概率,H(k,s,j)表示传感器s在时刻k处观测轨道j的观测矩阵,H(k,s,j)T为观测矩阵的转置矩阵,R-1(k,s,j)表示传感器s在时刻k处观测轨道j的观测噪声协方差矩阵的逆矩阵,以上数据由传感器观测层给出。
步骤3:融合层计算时刻k由于传感器观测产生的信息增益
步骤4:融合层计算时刻k+1的预测期望Fisher信息矩阵
基于时刻k的目标状态进行时刻k+1Fisher信息矩阵的预测,需要目标的状态转移矩阵以及产生的相应的过程噪声,如式(5)所示:
其中F(k)表示基于目标运动模型的状态转移矩阵,表示时刻k观测后期望更新的Fisher信息矩阵的逆矩阵,F(k)T表示状态转移矩阵的转置矩阵,Q(k)表示过程噪声的协方差矩阵,以上数据由传感器观测层给出。
步骤5:融合层计算时刻k+1的预测期望更新Fisher信息矩阵
其中πj(k)表示时刻k轨道j的观测概率,πD(k+1,s,j)是传感器s在时刻k+1处检测伪轨道j的概率,H(k+1,s,j)表示传感器s在时刻k+1处观测轨道j的观测矩阵,H(k+1,s,j)T为观测矩阵的转置矩阵。R-1(k+1,s,j)表示传感器s在时刻k+1处观测轨道j的观测噪声协方差矩阵的逆矩阵,以上数据由传感器观测层给出。
步骤6:融合层计算时刻k+1的信息增益
步骤7:决策层递归地计算N个时间步长传感器观测的累积信息增益J(k)
计算时刻k由于传感器观测产生的未来N步累计信息增益,根据目标优先级以及折扣因子进行缩放。即优先级越高,距离时刻k越近,获得的信息收益准确性越高。
其中γ是奖励折扣因子,αj是目标优先级,根据目标威胁程度进行判定。是到达时刻l处的期望Fisher信息矩阵,是所有传感器组件在时刻l处观测之后的期望更新的Fisher信息矩阵。
第二步:传感器调度
平台路径规划会产生新的环境观测需求,新的环境观测需求传给SRM进行传感器调度。SRM使用基于风险的奖励方法,同时考虑跟踪精度和对象特征,共同计算优化任务决策的奖励和成本,实现错误分类及丢失对象的风险最小化。
系统预测的目标状态由连续运动状态向量x和目标类别的离散集合y组成。连续运动状态向量x和目标类别的离散集合y一起形成混合连续离散状态(x,y)。传感器调度决策的目标是选择一个特定的(x′,y′)作为候选解,即基于目标的观测运动状态信息x′给出目标的类型判断y′。决策的风险由成本函数Co(x,y;x′,y′)定义的实际状态以及实际状态的联合概率密度函数(Probability Density Function,PDF)pXY(x,y)表示。
决策层的PRM做出的平台路径规划结果会产生新的环境观测需求,这些需求传给决策层的SRM进行传感器调度。SRM基于PRM的平台路径规划结果进行传感器调度决策,决策的结果是在传感器集合层选择合适的传感器及其行为,以实现错误分类及丢失对象的风险最小化。
步骤1:计算成本函数Co
成本函数考虑了目标的运动状态以及分类信息,结合成本矩阵C以及ε向量矩阵E得到
其中Co(x,y;x′,y′)指的是决策(x′,y′)产生的成本,x′指的目标的观测运动状态信息,y′为基于x′做出的目标类型判断,cyy与cy′y由步骤1.1定义的成本矩阵得到,ε(y′)由步骤1.2定义的ε向量矩阵得到。
步骤1.1:定义成本矩阵C
成本矩阵定义如下:
其中,M表示视野中目标的个数,K表示识别的种类,M和K基于平台路径规划结果得到。cMK表示将目标M识别为类别K产生的成本。
步骤1.2:定义ε向量矩阵E
E=(ε(1)...ε(K)) (11)
ε向量的元素为主观定义的,代表操作者对每个类别的不正确的运动状态估计产生的相对影响的判断,K表示识别的种类。
将式(10)和式(11)带入式(9),得到传感器调度决策的成本函数。
步骤2:定义传感器调度的决策风险R(x′,y′)
其中Co(x,y;x′,y′)指的是决策(x′,y′)产生的成本,pXY(x,y)指的是实际状态(x,y)的概率密度函数。
步骤3:决策层计算传感器观测后的状态概率密度函数p+′XY(x,y)
利用观测(z,w)进行更新之后的概率密度函数通过贝叶斯更新进行计算。
其中z表示观测向量,z∈RM,M为目标个数,R为实数集合,w表示对数据进行处理得到的离散类别信息,w∈{1...K},K为目标识别的种类,θ表示传感器的动作参数,pZW(z,w|x,y;θ)表示在状态(x,y)下采用传感器动作θ得到的观测(z,w)的概率,pXY +(x,y)指的是观测时间处状态的预测概率密度函数,pZW(z,w;θ)表示测量似然函数。
步骤4:决策层计算理论观测风险R+(z,w;θ)
步骤4.1:理论观测风险R+(z,w;θ)
步骤4.2:计算理论观测风险R+(z,w;θ)
将更新后状态的概率密度函数p+′ XY(x,y)代入公式(14):
步骤5:决策层计算预测的风险值<R+(θ)>
因为实际的观测结果是存在误差的,所以SRM必须依靠风险的预期值,由(16)式给出:
将公式(15)的代入公式(16),pZW(z,w;θ)项消去,得到:
步骤6:决策层计算传感器决策后的风险减少量J(θ)
J(θ)=R+-<R+(θ)> (18)
其中R+是在没有测量时的决策风险,由式(19)给出:
故传感器调度决策的目标就是选择合适的传感器行为,以最大化每个时间步骤上所有目标的总体风险减少量J(θ)。
步骤7:传感器集合层选择风险最小的传感器动作θ
根据决策层产生的调度结果,传感器集合层产生新的环境观测结果,进而开始新一轮传感器调度的闭环决策。
本发明的有益效果:
本发明实现传感器资源的高效分配,最终实现多传感器探测、目标追踪的风险最小化。
附图说明
图1为车载传感器系统的闭环协同调度框架。
图2为车载传感器闭环调度模型的实现。
图3为车载传感器系统闭环协同调度模型中的信息传递。
具体实施方式
下面结合说明书附图来对本发明进一步说明。
一种车载传感器系统的闭环协同调度方法,该方法采用马尔科夫决策过程,主要包括两个步骤,第一步是根据目标状态信息进行平台路径规划,第二步是根据路径规划后产生的状态改变进行传感器调度决策。
1)多传感器协同调度的理论基础
本发明设计了基于马尔科夫决策过程(Markov decision process,MDP)的方法进行车载传感器的闭环协同调度。首先,定义MDP的状态空间、动作空间以及奖励函数。假定MDP为全观测,即传感器的观测可以完全反应环境的状态,则状态空间指的是传感器的观测信息。动作指的是影响实际或者潜在观测的传感器命令,例如向特定目标方向转动雷达的动作会产生对目标范围的观测。每个动作都会导致状态转变,并在实际结果中产生误差以及不确定性。奖励量化了由于动作以及随后的状态转变产生的信息增益。
其次,定义车载传感器的调度策略。调度策略是给定信息状态的动作的函数。直观上,传感器调度策略可以被看作是一个表格或一个函数,用来指定在不同的条件下采取哪种传感器动作。例如,一种可能的调度策略是将每个传感器分配给其最接近的目标,或者分配传感器瞄准点以最大化检测到的目标的预期数目。本发明的车载传感器主要应用于目标探测及追踪领域,因而调度策略为选择预期风险最小的传感器进行探测及目标追踪。
最后,给出车载传感器调度的目标函数。目标函数是在阶段中积累的奖励的函数,并且可根据对特定任务的重要性的因素进行调节。例如,某些目标的状态信息所产生的奖励可以根据它们对任务的重要程度而升高或降低或者是根据动作的决定和实际执行之间的时间延迟,相应地减小期望奖励的折扣因子。本发明的车载传感器调度的目标函数基于风险模型,并结合了目标分类和运动信息以实现错误分类和丢失对象风险的最小化。
2)车载传感器系统闭环协同调度模型的实现
车载传感器闭环调度模型的实现如图2所示,其中传感器集合和环境单元共同组成了MDP的状态输入过程,具体指的是传感器资源对环境的一系列观测。融合层由一组上游数据融合组件(Upstream Data Fusion,UDF)和伪轨管理器组件(Pseudo-Track Manager,PTM)组成,结合传感器的观测信息进行数据关联以及融合,得到对目标的状态估计,并生成态势图像传输给决策层。决策层由一组动态资源管理器组件组成,包括平台路径规划以及传感器调度,前者产生信息状态的改变传输给后者,进而根据传感器调度策略生成最佳传感器分配决策。
1状态输入
状态主要是指传感器集合对环境要素的观测。传感器集合包括雷达,成像传感器以及红外传感器。雷达能够提供完整的目标位置信悬,测距能力强;成像传感器仅具有测角能力,但其测角能力高;红外传感器具有测角精度高,跟踪能力强的特点。三种传感器相互补充,实现对环境状态的完整观测。环境状态主要对包括平台空气动力学、卫星轨道传播、传感器现象学、目标动力学、目标特征、自然和人造地形、地面交通、天气、照明等。每个传感器生成由融合组件处理的合成测量数据。
2上游数据融合(UDF)
UDF是指传感器数据的处理、开发和融合尽可能接近原始传感器数据馈送。其功能由分布式自动化筛选器和融合软件组件组成,它们执行对象级上行数据挖掘,以检测、定位、跟踪和分类传感器观察到的对象。筛选器组件是传感器专用的,通常每个物理传感器或数据类型都有一个。对象级融合组件通过专门用于处理特定数据类型的多假设跟踪器(Multiple Hypothesis Tracker,MHT)实现。MHT用来进行状态估计和数据关联的处理,以生成目标状态和分类估计的轨迹信息。
3伪轨管理器(PTM)
PTM是一个自动化的软件组件,它创建、销毁和更新潜在但不可观察的轨迹(即伪轨迹),这些轨迹代表通过观察以前未被发现或丢失的目标而获得的信息收益,以及当不观察时随时间推移而导致的信息损失。PTM根据数据输入更新伪轨道,并提供系统信息状态的部分表示来补充由上游数据融合组件提供的信息状态。
PTM和UDF组件是互补的。UDF鼓励控制器将传感器注意力引导到当前跟踪的对象,而PTM鼓励资源管理器组件将传感器注意力引导到可能发现的新的对象或重新获取的丢失对象的区域。控制器目标函数以相同的方式处理实际轨道和伪轨道,以实现搜索和跟踪的统一处理。
PTM通过应用伪轨道来模拟丢失或未被发现的物体的可能位置。对于真实轨道,轨道的协方差和概率由MHT直接给出,而伪轨道协方差通过初始化完成,使得其3-σ误差椭圆大致处于感兴趣的搜索单元内。伪轨道概率表示搜索单元中目标数量信息的确定性,它通过传感器观察来模拟信息的获取。在每个传感器扫描之后,以(1)式更新每个伪轨道j的概率:
其中πD(k,s,j)是传感器s在时间步k处检测伪轨道j的概率。等式(1)表示传感器观察伪轨道获得的信息增益。
4动态资源管理实现
动态资源管理通过一对交互式的随机优化控制器实现的:一个用作生成平台路径规划命令的平台资源管理器(Platform Resource Manager,PRM),另一个用作生成传感器命令的传感器资源管理器(Sensor Resource Manager,SRM)。每个组件优化约束条件下基于信息的目标函数,并且PRM的结果被用作SRM的输入。PRM将MHT的分类估计信息转换为优先级值,以鼓励平台在视野内保持高优先级的轨道。SRM使用了基于风险的目标函数,将轨道分配给最低风险的传感器。由于PRM和SRM是独立优化的过程,所以SRM保持在较短的时间步长上,从而频繁地更新计划时间表,以迅速响应轨道状态或分类估计值的变化。
图3表示车载传感器系统闭环协同调度模型中的信息传递,具体步骤如下:
步骤一:传感器对环境状态进行观测,得到的观测信息传输给融合层并通过筛选器进行数据初步分析处理;
步骤二;筛选器处理的传感器观测信息传输给MHT以及PTM,分别用来生成真实轨道以及伪轨道的状态估计,并生成可视化的态势图像,传输给分析/展示层以及决策层;
步骤三:决策层根据目标的态势信息进行平台路径规划,规划的结果传输给传感器管理器进行调度决策;
步骤四:决策命令传输给传感器集合以进行新环境状态下的观测,并将观测结果反馈给融合层。

Claims (2)

1.一种车载传感器系统的闭环协同调度框架,其特征在于,包括传感器集合层、决策层和融合层;传感器集合层表示异构的传感器资源集合,传感器包括雷达、红外传感器和成像传感器;雷达、红外传感器和成像传感器执行决策层的命令,并产生观测数据;
车载传感器系统在工作环境中运作,工作环境包括被跟踪目标本身及影响其行为、表现和结果的环境因素;融合层结合环境因素以及传感器的观测数据,对目标进行状态估计以及下一个时刻的状态预测,并生成相应的目标态势图像;决策层利用融合层提供的数据信息以及目标态势图像,进行平台路径规划,产生的环境观测需求传递给车载传感器系统;决策层根据平台路径规划结果产生传感器的调度命令,指导传感器集合进行动作更新,实现复杂多变的环境下多传感器的精确探测和追踪。
2.根据权利要求1所述的闭环协同调度框架的协同调度方法,其特征在于,步骤如下:
第一步:平台路径规划
步骤1:融合层计算时刻k传感器观测前的期望Fisher信息矩阵
时刻k观测前的Fisher信息矩阵需要根据时刻k-1的目标状态进行预测,如式(2)所示:
其中πj(k)表示时刻k轨道j的观测概率,Pj(k|k-1)表示轨道协方差;
对于真实轨道,πj(k)和Pj(k|k-1)由融合层的MHT直接给出;
对于伪轨道,πj(k)计算公式如式(1)所示;Pj(k|k-1)通过人为输入得到,使得其3-σ误差椭圆处于预期的搜索单元内;σ为标准差常数;
其中πD(k,s,j)是传感器s在时刻k处检测伪轨道j的概率;
步骤2:融合层计算时刻k传感器观测之后得到的期望更新Fisher信息矩阵
其中πj(k)表示时刻k轨道j的观测概率,πD(k,s,j)是传感器s在时刻k处检测伪轨道j的概率,H(k,s,j)表示传感器s在时刻k处观测轨道j的观测矩阵,H(k,s,j)T为观测矩阵的转置矩阵,R-1(k,s,j)表示传感器s在时刻k处观测轨道j的观测噪声协方差矩阵的逆矩阵;
步骤3:融合层计算时刻k由于传感器观测产生的信息增益
步骤4:融合层计算时刻k+1的预测期望Fisher信息矩阵
其中F(k)表示基于目标运动模型的状态转移矩阵,表示时刻k观测后期望更新的Fisher信息矩阵的逆矩阵,F(k)T表示状态转移矩阵的转置矩阵,Q(k)表示过程噪声的协方差矩阵;
步骤5:融合层计算时刻k+1的预测期望更新Fisher信息矩阵
其中πj(k)表示时刻k轨道j的观测概率,πD(k+1,s,j)是传感器s在时刻k+1处检测伪轨道j的概率,H(k+1,s,j)表示传感器s在时刻k+1处观测轨道j的观测矩阵,H(k+1,s,j)T为观测矩阵的转置矩阵;R-1(k+1,s,j)表示传感器s在时刻k+1处观测轨道j的观测噪声协方差矩阵的逆矩阵;
步骤6:融合层计算时刻k+1的信息增益
步骤7:决策层递归地计算N个时间步长传感器观测的累积信息增益J(k)
计算时刻k由于传感器观测产生的未来N步累计信息增益,根据目标优先级以及折扣因子进行缩放;
其中γ是奖励折扣因子,αj是目标优先级,根据目标威胁程度进行判定;
是到达时刻l处的期望Fisher信息矩阵,是所有传感器组件在时刻l处观测之后的期望更新的Fisher信息矩阵;
第二步:传感器调度
步骤1:计算成本函数Co
其中Co(x,y;x′,y′)指的是决策(x′,y′)产生的成本,x′指的目标的观测运动状态信息,y′为基于x′做出的目标类型判断,cyy与cy′y由步骤1.1定义的成本矩阵得到,ε(y′)由步骤1.2定义的ε向量矩阵得到;
步骤1.1:定义成本矩阵C
成本矩阵定义如下:
其中,M表示视野中目标的个数,K表示识别的种类,M和K基于平台路径规划结果得到;cMK表示将目标M识别为类别K产生的成本;
步骤1.2:定义ε向量矩阵E
E=(ε(1)...ε(K)) (11)
ε向量的元素为主观定义的,代表操作者对每个类别的不正确的运动状态估计产生的相对影响的判断,K表示识别的种类;
将式(10)和式(11)带入式(9),得到传感器调度决策的成本函数;
步骤2:定义传感器调度的决策风险R(x′,y′)
其中Co(x,y;x′,y′)指的是决策(x′,y′)产生的成本,pXY(x,y)指的是实际状态(x,y)的概率密度函数;
步骤3:决策层计算传感器观测后的状态概率密度函数p+′ XY(x,y)
利用观测(z,w)进行更新之后的概率密度函数通过贝叶斯更新进行计算;
其中z表示观测向量,z∈RM,M为目标个数,R为实数集合,w表示对数据进行处理得到的离散类别信息,w∈{1...K},K为目标识别的种类,θ表示传感器的动作参数;
pZW(z,w|x,y;θ)表示在状态(x,y)下采用传感器动作θ得到的观测(z,w)的概率,pXY +(x,y)指的是观测时间处状态的预测概率密度函数,pZW(z,w;θ)表示测量似然函数;
步骤4:决策层计算理论观测风险R+(z,w;θ)
步骤4.1:理论观测风险R+(z,w;θ)
步骤4.2:计算理论观测风险R+(z,w;θ)
将更新后状态的概率密度函数p+′ XY(x,y)代入公式(14):
步骤5:决策层计算预测的风险值<R+(θ)>
将公式(15)的代入公式(16),pZW(z,w;θ)项消去,得到
步骤6:决策层计算传感器决策后的风险减少量J(θ)
J(θ)=R+-<R+(θ)> (18)
其中R+是在没有测量时的决策风险:
步骤7:传感器集合层选择风险最小的传感器动作θ
根据决策层产生的调度结果,传感器集合层产生新的环境观测结果,开始新一轮传感器调度的闭环决策。
CN201811429564.1A 2018-11-28 2018-11-28 一种车载传感器系统的闭环协同调度框架的协同调度方法 Active CN109657928B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811429564.1A CN109657928B (zh) 2018-11-28 2018-11-28 一种车载传感器系统的闭环协同调度框架的协同调度方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811429564.1A CN109657928B (zh) 2018-11-28 2018-11-28 一种车载传感器系统的闭环协同调度框架的协同调度方法

Publications (2)

Publication Number Publication Date
CN109657928A true CN109657928A (zh) 2019-04-19
CN109657928B CN109657928B (zh) 2022-10-04

Family

ID=66111654

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811429564.1A Active CN109657928B (zh) 2018-11-28 2018-11-28 一种车载传感器系统的闭环协同调度框架的协同调度方法

Country Status (1)

Country Link
CN (1) CN109657928B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110399898A (zh) * 2019-06-17 2019-11-01 中国北方车辆研究所 一种无人车辆多传感器信息融合体系架构
CN110427034A (zh) * 2019-08-13 2019-11-08 浙江吉利汽车研究院有限公司 一种基于车路协同的目标追踪系统及方法
WO2021077818A1 (zh) * 2019-10-26 2021-04-29 华为技术有限公司 预测运动轨迹的方法和系统
CN112749853A (zh) * 2019-10-29 2021-05-04 深圳市丰农科技有限公司 车辆传感器管理方法及装置、集合装置收集器及存储介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101465071A (zh) * 2009-01-08 2009-06-24 上海交通大学 多平台目标跟踪与分布交互仿真系统
CN102637036A (zh) * 2012-05-08 2012-08-15 北京理工大学 一种复合式仿生四足机器人控制器
CN107462882A (zh) * 2017-09-08 2017-12-12 深圳大学 一种适用于闪烁噪声的多机动目标跟踪方法及系统
CN107783545A (zh) * 2016-08-25 2018-03-09 大连楼兰科技股份有限公司 基于ooda环多传感器信息融合的灾后救援旋翼无人机避障系统
US20180259341A1 (en) * 2017-03-08 2018-09-13 Northrop Grumman Systems Corporation Adaptive navigation for airborne, ground and dismount applications (anagda)

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101465071A (zh) * 2009-01-08 2009-06-24 上海交通大学 多平台目标跟踪与分布交互仿真系统
CN102637036A (zh) * 2012-05-08 2012-08-15 北京理工大学 一种复合式仿生四足机器人控制器
CN107783545A (zh) * 2016-08-25 2018-03-09 大连楼兰科技股份有限公司 基于ooda环多传感器信息融合的灾后救援旋翼无人机避障系统
US20180259341A1 (en) * 2017-03-08 2018-09-13 Northrop Grumman Systems Corporation Adaptive navigation for airborne, ground and dismount applications (anagda)
CN107462882A (zh) * 2017-09-08 2017-12-12 深圳大学 一种适用于闪烁噪声的多机动目标跟踪方法及系统

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
FENG WANG等: ""Dynamic clustering in wireless sensor network for target tracking based on the fisher information of modified Kalman filter"", 《2016 3RD INTERNATIONAL CONFERENCE ON SYSTEMS AND INFORMATICS (ICSAI)》 *
YANJUN SHI等: ""An Adaptive Track Fusion Method with Unscented Kalman Filter"", 《2018 IEEE INTERNATIONAL CONFERENCE ON SMART INTERNET OF THINGS》 *
张桥: ""多传感器信息融合技术在智能车辆避障中的应用"", 《中国优秀博硕士学位论文全文数据库(硕士)工程科技Ⅱ辑》 *
赵丽丽: ""基于多源传感器信息融合的目标跟踪算法研究"", 《中国优秀博硕士学位论文全文数据库(硕士)信息科技辑》 *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110399898A (zh) * 2019-06-17 2019-11-01 中国北方车辆研究所 一种无人车辆多传感器信息融合体系架构
CN110427034A (zh) * 2019-08-13 2019-11-08 浙江吉利汽车研究院有限公司 一种基于车路协同的目标追踪系统及方法
CN110427034B (zh) * 2019-08-13 2022-09-02 浙江吉利汽车研究院有限公司 一种基于车路协同的目标追踪系统及方法
WO2021077818A1 (zh) * 2019-10-26 2021-04-29 华为技术有限公司 预测运动轨迹的方法和系统
CN112749853A (zh) * 2019-10-29 2021-05-04 深圳市丰农科技有限公司 车辆传感器管理方法及装置、集合装置收集器及存储介质

Also Published As

Publication number Publication date
CN109657928B (zh) 2022-10-04

Similar Documents

Publication Publication Date Title
CN109657928A (zh) 一种车载传感器系统的闭环协同调度框架及调度方法
US11726477B2 (en) Methods and systems for trajectory forecasting with recurrent neural networks using inertial behavioral rollout
JP5183665B2 (ja) ロボットの少なくとも1つの将来的活動を決定する決定メカニズム、方法、モジュールおよび決定するように構成されたロボット
Spaan et al. Active cooperative perception in network robot systems using POMDPs
Bakker et al. Hierarchical dynamic programming for robot path planning
JP2021140445A (ja) 情報処理装置、推論モデル構築方法、情報処理方法、推論モデル、プログラム、及び記録媒体
CN110262563A (zh) 多无人机协同搜索水上目标的方法
CN110806211A (zh) 机器人自主探索建图的方法、设备及存储介质
CN110111359A (zh) 多目标对象跟踪方法、执行该方法的设备和计算机程序
CN114595898A (zh) 一种考虑航道环境的船舶智能操纵方法
CN114167898A (zh) 一种无人机收集数据的全局路径规划方法及系统
Mansouri et al. Visual subterranean junction recognition for mavs based on convolutional neural networks
Zhao et al. Improved Rao-Blackwellised particle filter based on randomly weighted particle swarm optimization
CN113674310B (zh) 一种基于主动视觉感知的四旋翼无人机目标跟踪方法
Xu et al. Ant clustering PHD filter for multiple-target tracking
Miller et al. Coordinated guidance of autonomous uavs via nominal belief-state optimization
Jiang et al. Learning decentralized control policies for multi-robot formation
Rottmann et al. Adaptive autonomous control using online value iteration with gaussian processes
US20230090127A1 (en) Device and method for controlling an agent
Zhang et al. An autonomous robotic system for intralogistics assisted by distributed smart camera network for navigation
Hu et al. Algorithm and system development for robotic micro-volume herbicide spray towards precision weed management
Riccio et al. LoOP: Iterative learning for optimistic planning on robots
CN113671942A (zh) 用于控制机器人的设备和方法
JP6927161B2 (ja) 学習装置、予測装置、方法、及びプログラム
CN114077242A (zh) 用于在具有多个硬件代理的控制情况下控制硬件代理的设备和方法

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