飞机集群执行任务的方法和长机
技术领域
本公开涉及飞行控制领域,特别涉及一种飞机集群执行任务的方法和长机。
背景技术
固定翼飞机(简称“飞机”)集群,通常由长机将拍摄的图像传回地面站,地面站的工作人员基于长机传回的图像发现目标,将目标的信息传送给长机和僚机。地面站的工作人员还可以指示长机继续监视目标,或者指示若干僚机攻击目标等。
发明内容
发明人发现,地面站的工作人员基于长机传回的图像发现目标,使得工作人员的工作负担比较重。此外,飞机与地面站之间的通信链路存在时延或链路中断等问题,会导致目标发现以及任务指令出现时延较长以及可靠性的问题。
本公开由长机从地面的监控图像中自主地识别目标,并调度僚机执行任务,可以减轻工作人员负担,并且减少对飞机与地面站之间的通信链路性能的依赖,使得目标发现和任务执行的实时性和可靠性得到提高。
本公开的一些实施例提出一种飞机集群执行任务的方法,包括:
飞机集群中的长机基于所述长机搭载的相机获取地面的监控图像;
利用目标检测模型从所述监控图像中识别目标,所述目标检测模型预先利用训练图像和目标标注信息进行训练;
调度飞机集群中的若干僚机对所述目标执行相应的任务。
在一些实施例中,长机将基于目标在图像上的像素点所确定的目标在惯性坐标系下的位置信息发送给被调度的僚机。
在一些实施例中长机确定目标在惯性坐标系下的位置信息包括:
根据相机的焦距、第一高度和第二高度,确定目标在相机坐标系下的高度,其中,第一高度为相机的光心在惯性坐标系下的高度,第二高度为目标在图像上的像素点在惯性坐标系下的高度;
根据相机的焦距以及像素与长度之间的换算因子,确定基于目标在相机坐标系下的高度所形成的齐次矩阵与目标在相机坐标系下的位置点之间的内参矩阵;
根据齐次矩阵和内参矩阵,并结合云台坐标系到相机坐标系的齐次转换矩阵、飞机机体坐标系到云台坐标系的齐次转换矩阵、飞机坐标系到飞机机体坐标系的齐次转换矩阵和惯性坐标系到飞机机体坐标系的齐次转换矩阵,计算目标在惯性坐标系下的位置信息。
在一些实施例中长机确定目标在相机坐标系下的高度包括:
构建比例关系式,所述比例关系式为:第一高度与第二高度的差值与第一高度之间的比值等于相机的焦距与目标在相机坐标系下的高度之间的比值;
基于所述比例关系式,计算得到目标在相机坐标系下的高度。
在一些实施例中长机计算目标在惯性坐标系下的位置信息包括:
将内参矩阵与各个齐次转换矩阵相乘得到第一矩阵,将第一矩阵的逆矩阵与齐次矩阵相乘所得到的结果确定为目标在惯性坐标系下的位置信息。
在一些实施例中还包括:长机根据监控图像监控任务执行的情况,并根据任务执行的情况确定是否继续调度僚机对所述目标执行相应的任务。
在一些实施例中飞机集群在编队飞行过程中,僚机根据长机的GPS坐标以及本僚机在长机局部坐标系下的坐标确定本僚机的GPS坐标,包括:
根据长机的GPS坐标,并结合GPS坐标系与ECEF坐标系的转换矩阵和ECEF坐标系与NED坐标系的转换矩阵,计算长机的NED坐标;
根据长机的NED坐标与僚机在长机局部坐标系下的坐标,计算僚机的NED坐标;
根据僚机的NED坐标,并结合GPS坐标系与ECEF坐标系的转换矩阵的逆矩阵和ECEF坐标系与NED坐标系的转换矩阵的逆矩阵,计算僚机的GPS坐标。
本公开的一些实施例提出一种飞机集群中的长机,包括:
图像获取单元,被配置为基于搭载的相机获取地面的监控图像;
目标识别单元,被配置为利用目标检测模型从所述监控图像中识别目标,所述目标检测模型预先利用训练图像和目标标注信息进行训练;
僚机调度单元,被配置为调度飞机集群中的若干僚机对所述目标执行相应的任务。
在一些实施例中还包括:目标位置解算单元,被配置为基于目标在图像上的像素点确定目标在惯性坐标系下的位置信息;
所述僚机调度单元,还被配置为将目标在惯性坐标系下的位置信息发送给被调度的僚机。
在一些实施例中还包括:监控单元,被配置为根据监控图像监控任务执行的情况;
所述僚机调度单元,还被配置为根据任务执行的情况确定是否继续调度僚机对所述目标执行相应的任务。
本公开的一些实施例提出一种飞机集群中的长机,包括:存储器;以及耦接至所述存储器的处理器,所述处理器被配置为基于存储在所述存储器中的指令,执行前述任一个实施例中的飞机集群执行任务的方法。
本公开的一些实施例提出一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现前述任一个实施例中的飞机集群执行任务的方法。
附图说明
下面将对实施例或相关技术描述中所需要使用的附图作简单地介绍。根据下面参照附图的详细描述,可以更加清楚地理解本公开,
显而易见地,下面描述中的附图仅仅是本公开的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本公开的飞机集群系统的一些实施例的示意图。
图2为本公开的僚机根据长机的GPS坐标以及本僚机在长机局部坐标系下的坐标确定本僚机的GPS坐标的一些实施例的示意图。
图3为本公开飞机集群执行任务的方法一些实施例的示意图。
图4a和图4b示出了坐标系(1-5)的位置关系示意图。
图5a和图5b示出了本公开的相机坐标系和像素坐标系(5-6)的建模示意图。
图6为本公开飞机集群中的长机的一些实施例的结构示意图。
图7为本公开飞机集群中的长机的一些实施例的结构示意图。
具体实施方式
下面将结合本公开实施例中的附图,对本公开实施例中的技术方案进行清楚、完整地描述。
图1为本公开的飞机集群系统的一些实施例的示意图。
如图1所示,飞机集群系统10包括长机11、若干僚机12和地面站13。长机11与地面站13之间可以远程通信。僚机12与地面站13之间可以不通信。长机11与若干僚机12组成一个局域网,通过局域网长机11与僚机12之间可以通信。如果长机11出现意外,某个僚机12可以成为长机。
在飞机集群起飞阶段,长机被首先发射,然后各个僚机被逐次发射。僚机会实时接收长机的消息,例如长机的消息中包括长机的GPS(Global Positioning System,全球定位系统)坐标、速度、航行等信息。僚机根据长机的消息自主规划轨迹。
为了规划轨迹,僚机需要根据长机的GPS坐标以及本僚机在长机局部坐标系下的坐标确定本僚机的GPS坐标。
其中,长机局部坐标系,以长机质心为原点O,X轴指向地球正北,Y指向地球东,X-Y平面与水平面平行,Z轴与X-Y平面垂直并指向下。长机局部坐标系与NED(North-East-Down,北东地)坐标系重合。设僚机i在长机局部坐标系下坐标为:
设长机的GPS坐标为
其中
分别为长机的经度、维度和高度。
如图2所示,僚机根据长机的GPS坐标以及本僚机在长机局部坐标系下的坐标确定本僚机的GPS坐标包括:
步骤21,根据长机的GPS坐标,并结合GPS坐标系与ECEF(Earth Centered EarthFixed,地心地固)坐标系的转换矩阵和ECEF坐标系与NED坐标系的转换矩阵,计算长机的NED坐标。
公式表示为:
其中,
表示长机的NED坐标,其中的
分别表示长机的NED坐标在其x轴,y轴,z轴方向的值,T
1表示GPS坐标系与ECEF坐标系的转换矩阵,T
2表示ECEF坐标系与NED坐标系的转换矩阵,
表示长机的GPS坐标,T
1和T
2的值参考现有技术。
其中,ECEF坐标系,原点的位置在地球质心,X轴通过格林尼治线和赤道线的交点,正方向为原点指向交点方向,Z轴通过原点指向北极,Y轴与X轴、Z轴构成右手坐标系。
步骤22,根据长机的NED坐标与僚机在长机局部坐标系下的坐标,计算僚机的NED坐标。
公式表示为:
其中,
表示僚机i的NED坐标,其中的
分别表示僚机i的NED坐标在其x轴,y轴,z轴方向的值。其他符号的含义参考前述。
步骤23,根据僚机的NED坐标,并结合GPS坐标系与ECEF坐标系的转换矩阵的逆矩阵和ECEF坐标系与NED坐标系的转换矩阵的逆矩阵,计算僚机的GPS坐标。
公式表示为:
其中,
表示僚机i的GPS坐标。其他符号的含义参考前述。
飞机集群起飞后,长机与僚机的编队飞行。编队飞行模式可以预先设置或根据长机的指示进行调整。编队飞行模式例如可以是以长机为中心的中心模式或者以长机为首的主从模式等,但不限于所举示例。
在编队飞行过程中,飞机集群以长机主导和僚机执行的协作方式完成相应的任务。下面具体描述。
图3为本公开飞机集群执行任务的方法一些实施例的示意图。
如图3所示,该实施例的方法包括:
步骤31,飞机集群中的长机基于所述长机搭载的相机获取地面的监控图像。
步骤32,长机利用目标检测模型从所述监控图像中识别目标。
其中,目标检测模型预先利用训练图像和目标标注信息进行训练。目标检测模型例如可以选用MobileNet-SSD模型,以提高目标识别的实时性。
在长机识别目标之后,可以直接执行步骤33,也可以将目标信息发送给地面站进行确认,确认之后再执行步骤33。
步骤33,长机调度飞机集群中的若干僚机对所述目标执行相应的任务。
任务例如可以是区域救援,森林救火,物资投放,反恐侦察,目标攻击等。
在步骤33之后,还可以选择性地执行步骤34。
步骤34,长机根据监控图像监控任务执行的情况,并根据任务执行的情况确定是否继续调度僚机对所述目标执行相应的任务。
以救火任务为例,按照预设的目标以及相应的僚机调度策略,长机第一次向第1,2号僚机发出向火灾位置处投放灭火剂的指令,第3,4,5号僚机待命,同时长机观察火势情况,当第1,2号僚机执行完救火任务后,若火灾未被扑灭,则长机继续向第3,4,5号僚机发送向火灾位置处投放灭火剂的指令,继续执行救火任务。其中,不同的目标可以设置不同的僚机调度策略,相同的目标根据需要可以设置相同的或不同的僚机调度策略。
上述实施例,由长机从地面的监控图像中自主地识别目标,并调度僚机执行任务,可以减轻工作人员负担,并且减少对飞机与地面站之间的通信链路性能的依赖,使得目标发现和任务执行的实时性和可靠性得到提高。
在长机调度僚机时,长机可以将基于目标在图像上的像素点所确定的目标在惯性坐标系下的位置信息发送给被调度的僚机,以便僚机知道目标的位置信息。下面具体描述目标的位置信息的解算过程。
下面定义一些坐标系。图4a和图4b示出了坐标系(1-5)的位置关系示意图。
(1)惯性坐标系(inertial frame),记为O
I-X
IY
IZ
I。原点O
I在起飞点(HOME),X
I指向北(North),Y
I指向东(East),Z
I指向地,坐标为(X
I,Y
I,Z
I)。
表示原点O
I与飞机重心(记为CM)之间的距离。
(2)飞机坐标系(vehicle frame),记为Ov-XvYvZv。原点Ov在飞机重心(记为CM),Xv指向北,Yv指向东,Zv指向地,坐标为(Xv,Yv,Zv)
(3)机体坐标系(body frame),记为Ob-XbYbZb。原点Ob在飞机重心,Xb指向机头,Yb在机体平面内指向右侧机翼,Zb垂直机体平面指向下,坐标为(Xb,Yb,Zb)。
(4)云台坐标系(gimbal frame),记为Og-XgYgZg。原点Og在云台重心(记为Gimbal),Xg沿光轴方向,Yg平行于图像平台向右,Zg平行于图像平面向下,坐标为(Xg,Yg,Zg)。
(5)相机坐标系(camera frame),记为Oc-XcYcZc。原点Oc在光心,Xc平行图像平面向下,Yc平行图像平面向右,Zc平行光轴向前,坐标为(Xv,Yv,Zv)。
(6)像素坐标系(pixel frame),记为Op-XpYp。原点Op在图像右上角,坐标(Xp,Yp),Xp,Yp为像素值。
下面定义一些符号。
vi表示向量v在坐标系i中的表达。
可理解地,一旦定义好坐标系i,j,则坐标系i到坐标系j的旋转矩阵
平移矩阵
齐次转换矩阵
都是可以确定的已知量。例如,基于前述定义的坐标系(1-5),则云台坐标系到相机坐标系的齐次转换矩阵
飞机机体坐标系到云台坐标系的齐次转换矩阵
飞机坐标系到飞机机体坐标系的齐次转换矩阵
和惯性坐标系到飞机机体坐标系的齐次转换矩阵
等,都是可以确定的已知量。
图5a和图5b示出了本公开的相机坐标系和像素坐标系(5-6)的建模示意图。下面结合图5a和图5b描述长机基于目标在图像上的像素点确定目标在惯性坐标系下的位置信息。
目标P在相机坐标系下的位置点为
在图像上的像素坐标为q=(x
ip,y
ip,1,1)
T。相机的焦距为f。令λ=p
z。其中,p
x,p
y,p
z的单位均为长度单位,例如米(m)。x
ip,y
ip的单位均是像素单位,例如像素值。S
x、S
y分别为像素与长度之间在x、y方向的换算因子,x
im、y
im的单位是长度单位,例如米。在相机坐标系下,将像素单位换算成长度单位(例如将像素值换算成米),则有如下公式:
xim=(-yip+0y)Sy,yim=(xip-0x)Sx
通过相似三角形,有如下公式:
其中,基于目标在相机坐标系下的高度λ所形成的齐次矩阵为:
其中,I为单位矩阵,C表示齐次矩阵Λq与目标在相机坐标系下的位置点
之间的内参矩阵,C为:
可见,根据相机的焦距以及像素与长度之间的换算因子,确定基于目标在相机坐标系下的高度所形成的齐次矩阵与目标在相机坐标系下的位置点之间的内参矩阵,0x=0y=0。
由矩阵转换关系得出:
由上式得出:
可见,根据齐次矩阵和内参矩阵,并结合云台坐标系到相机坐标系的齐次转换矩阵、飞机机体坐标系到云台坐标系的齐次转换矩阵、飞机坐标系到飞机机体坐标系的齐次转换矩阵和惯性坐标系到飞机机体坐标系的齐次转换矩阵,计算目标在惯性坐标系下的位置信息。即,将内参矩阵与各个齐次转换矩阵相乘得到第一矩阵
将第一矩阵的逆矩阵
与齐次矩阵Λq相乘所得到的结果确定为目标在惯性坐标系下的位置信息
因此,计算出λ值,即可计算出Λq,进而计算出
下面描述λ值的计算过程。
设p
cc为相机的光心位置,则
光心在惯性坐标系下的齐次坐标为:
像素坐标q=(xip,yip,1,1)T在惯性坐标系下的坐标为:
为相机的光心在惯性坐标系下的坐标,相机的光心在惯性坐标系下的高度为
为目标在图像上的像素点在惯性坐标系下的坐标,目标在图像上的像素点在惯性坐标系下的高度为
目标P在光轴上的投影为B,d为
与P之间的距离,λ为
与B之间的距离,m为
与
之间的距离。三角形
与三角形
相似,则构建如下比例关系式,比例关系式为:第一高度与第二高度的差值与第一高度之间的比值等于相机的焦距与目标在相机坐标系下的高度之间的比值,公式表示如下:
基于所述比例关系式,计算得到目标在相机坐标系下的高度:
图6为本公开飞机集群中的长机的一些实施例的结构示意图。
如图6所示,该实施例的长机包括:
图像获取单元61,被配置为基于搭载的相机获取地面的监控图像;
目标识别单元62,被配置为利用目标检测模型从所述监控图像中识别目标,所述目标检测模型预先利用训练图像和目标标注信息进行训练;
僚机调度单元63,被配置为调度飞机集群中的若干僚机对所述目标执行相应的任务。
在一些实施例中,长机还包括:目标位置解算单元64,被配置为基于目标在图像上的像素点确定目标在惯性坐标系下的位置信息;所述僚机调度单元63,还被配置为将目标在惯性坐标系下的位置信息发送给被调度的僚机。
在一些实施例中,长机还包括:监控单元65,被配置为根据监控图像监控任务执行的情况;所述僚机调度单元63,还被配置为根据任务执行的情况确定是否继续调度僚机对所述目标执行相应的任务。
图7为本公开飞机集群中的长机的一些实施例的结构示意图。
如图7所示,该实施例的长机包括:存储器71;以及耦接至所述存储器的处理器72,所述处理器被配置为基于存储在所述存储器中的指令,执行前述任一个实施例的飞机集群执行任务的方法。
其中,存储器610例如可以包括系统存储器、固定非易失性存储介质等。系统存储器例如存储有操作系统、应用程序、引导装载程序(Boot Loader)以及其他程序等。
本领域内的技术人员应当明白,本公开的实施例可提供为方法、系统、或计算机程序产品。因此,本公开可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本公开可采用在一个或多个其中包含有计算机可用程序代码的计算机可用非瞬时性存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
以上所述仅为本公开的较佳实施例,并不用以限制本公开,凡在本公开的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本公开的保护范围之内。