发明内容
本发明实施例的目的在于提供一种基于无人机的目标定位方法、装置及系统,提高定位目标的准确性。
为达到上述目的,本发明实施例公开了一种基于无人机的目标定位方法,包括:
获得至少两台无人机中相机对准同一目标后的位置及角度数据;
根据所获得的位置及角度数据,确定所述每台无人机中相机与所述目标之间的方向向量;
根据所确定的每个方向向量,确定所述目标的位置。
可选的,所述获得至少两台无人机中相机对准同一目标后的位置及角度数据,可以包括:
获得至少两台无人机中相机同时对准同一目标后的位置及角度数据。
可选的,所述至少两台无人机中包括第一无人机和至少一台第二无人机;
所述获得至少两台无人机中相机对准同一目标后的位置及角度数据,可以包括:
接收所述第一无人机发送的对准目标的信息;
向每台第二无人机发送对准所述目标的指令;
在接收到所述每台第二无人机发送的对准所述目标的信息的情况下,确定所述第一无人机及所述每台第二无人机中相机的位置及角度数据。
可选的,在接收到所述每台第二无人机发送的对准所述目标的信息的情况下,所述方法还可以包括:
向所述第一无人机发送第一调整指令,所述第一调整指令中携带有位置及角度数据,以使得所述第一无人机根据所述第一调整指令对自身相机的位置及角度进行调整;
向所述每台第二无人机分别发送第二调整指令,所述第二调整指令中携带有位置及角度数据,以使得所述每台第二无人机分别根据所接收到的第二调整指令对自身相机的位置及角度进行调整;其中,发送的每个第二调整指令中携带的数据相同或不同;
所述确定所述第一无人机及所述每台第二无人机中相机的位置及角度数据,包括:
确定所述第一无人机及所述每台第二无人机调整后的相机的位置及角度数据。
可选的,所述根据所确定的每个方向向量,确定所述目标的位置,可以包括:
将与所确定的每个方向向量的距离之和最小的点确定为所述目标的位置。
可选的,所述至少两台无人机中包括第三无人机和第四无人机;
所述根据所获得的位置及角度数据,确定所述每台无人机中相机与目标之间的方向向量,可以包括:
根据所获得的所述第三无人机中相机的位置及角度数据,确定所述第三无人机中相机与所述目标之间的第一方向向量;
根据所获得的所述第四无人机中相机的位置及角度数据,确定所述第四无人机中相机与所述目标之间的第二方向向量;
所述根据所确定的每个向量,确定所述目标的位置,可以包括:
确定所述第一方向向量与所述第二方向向量的交点为所述目标的位置。
为达到上述目的,本发明实施例还公开了一种基于无人机的目标定位装置,包括:
获得模块,用于获得至少两台无人机中相机对准同一目标后的位置及角度数据;
第一确定模块,用于根据所获得的位置及角度数据,确定所述每台无人机中相机与所述目标之间的方向向量;
第二确定模块,用于根据所确定的每个方向向量,确定所述目标的位置。
可选的,所述获得模块,具体可以用于:
获得至少两台无人机中相机同时对准同一目标后的位置及角度数据。
可选的,所述至少两台无人机中包括第一无人机和至少一台第二无人机;
所述获得模块,可以包括:
接收子模块,用于接收所述第一无人机发送的对准目标的信息;
第一发送子模块,用于向每台第二无人机发送对准所述目标的指令;
确定子模块,用于在接收到所述每台第二无人机发送的对准所述目标的信息的情况下,确定所述第一无人机及所述每台第二无人机中相机的位置及角度数据。
可选的,所述装置还可以包括:
第二发送模块,用于在接收到所述每台第二无人机发送的对准所述目标的信息的情况下,向所述第一无人机发送第一调整指令,所述第一调整指令中携带有位置及角度数据,以使得所述第一无人机根据所述第一调整指令对自身相机的位置及角度进行调整;
第三发送模块,用于在接收到所述每台第二无人机发送的对准所述目标的信息的情况下,向所述每台第二无人机分别发送第二调整指令,所述第二调整指令中携带有位置及角度数据,以使得所述每台第二无人机分别根据所接收到的第二调整指令对自身相机的位置及角度进行调整;其中,发送的每个第二调整指令中携带的数据相同或不同;
所述确定子模块,具体用于:在接收到所述每台第二无人机发送的对准所述目标的信息的情况下,确定所述第一无人机及所述每台第二无人机调整后的相机的位置及角度数据。
可选的,所述第二确定模块,具体可以用于:
将与所确定的每个方向向量的距离之和最小的点确定为所述目标的位置。
可选的,所述至少两台无人机中包括第三无人机和第四无人机;
所述第一确定模块,具体可以用于:
根据所获得的所述第三无人机中相机的位置及角度数据,确定所述第三无人机中相机与所述目标之间的第一方向向量;
根据所获得的所述第四无人机中相机的位置及角度数据,确定所述第四无人机中相机与所述目标之间的第二方向向量;
所述第二确定模块,具体可以用于:
确定所述第一方向向量与所述第二方向向量的交点为所述目标的位置。
为达到上述目的,本发明实施例还公开了一种基于无人机的目标定位系统,包括:主机、至少两台无人机以及至少两个地面站,所述无人机与所述地面站一一对应;其中,
所述无人机,用于将自身相机对准目标;获得所述相机的位置及角度数据;将所述数据发送给自身对应的地面站;
所述地面站,用于接收无人机发送的所述数据,将所述数据发送给所述主机;
所述主机中设置有上述任一项目标定位装置。
可选的,所述主机设置于任一地面站或者任一无人机中。
应用本发明实施例,通过至少两台无人机对目标进行定位,根据该至少两台无人机中相机对准同一目标后的位置及角度数据,确定每台无人机中相机与目标之间的方向向量,根据所确定的方向向量,确定目标的位置,由此可见,在本方案中,根据多台无人机中相机的位置及角度数据确定目标所在位置,不需要利用三角法,也就不要求目标所在地面与无人机飞行位置正对地面位于同一海拔高度。也就是说,目标所在地面与无人机飞行位置正对地面的海拔高度差不影响目标定位的准确性,因此,应用本方案,提高了定位目标的准确性。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
为了解决上述技术问题,本发明实施例提供了一种基于无人机的目标定位方法、装置及系统,该系统可以如图2所示,包括:至少两台无人机(无人机1、无人机2……无人机n)、至少两个地面站(地面站1、地面站2……地面站n)以及一个主机,其中,地面站与无人机一一对应。本发明实施例提供的基于无人机的目标定位方法适用于该系统中的主机,该主机可以为计算机、平板电脑、手机等电子设备,当然也可以设置于地面站中,在此不做限制。下面首先对本发明实施例提供的基于无人机的目标定位方法进行详细说明。
图3为本发明实施例提供的一种基于无人机的目标定位方法的流程示意图,包括:
S301:获得至少两台无人机中相机对准同一目标后的位置及角度数据。
相机的位置数据可以理解为无人机中相机所在位置的坐标值,该坐标值可以包括经纬度及高度数据;相机的角度数据可以理解为相机的姿态信息,具体表达形式可以为四元数、旋转矩阵、欧拉角等。
在本发明所示实施例中,可以对一台无人机(第一无人机)进行航线及目标的设定,使该第一无人机按照设定的航线飞行,并且在飞行过程中,对地面区域进行扫描监视。当第一无人机扫描到设定的目标时,第一无人机向主机发送对准目标的信息,该信息中还可以包括目标的大致位置、针对目标采集的图像等等,在此不做限制。
主机在接收到该信息后,向每台第二无人机发送对准该目标的指令。在本实施方式中,将先对准目标的无人机称之为第一无人机,后对准目标的无人机称之为第二无人机,第二无人机可以有多台。也就是说,主机调度一台或多台第二无人机对准该目标。
当上述第二无人机对准该目标时,第二无人机向主机发送对准目标的信息,该信息中还可以包括目标的大致位置、针对目标采集的图像等等,在此不做限制。
也就是说,此时,至少有两台无人机(第一无人机和至少一台第二无人机)的相机对准了目标,这种情况下,确定已对准目标的无人机中相机的位置及角度数据。
当然,在本发明所示实施例中,也可以对多台无人机都进行航线及目标的设定,使该多台无人机都按照设定的航线飞行,并且在飞行过程中,对地面区域进行扫描监视。
在本实施例中,将先对准目标的无人机称之为第一无人机,后对准目标的无人机称之为第二无人机,第二无人机可以有多台。当第一无人机扫描到设定的目标时,第一无人机向主机发送对准目标的信息,该信息可以包括目标的大致位置、针对目标采集的图像等等,在此不做限制。
主机在接收到该信息后,向每台第二无人机发送对准该目标的指令。每台第二无人机扫描到该目标时,第二无人机向主机发送对准目标的信息,该信息中还可以包括目标的大致位置、针对目标采集的图像等等,在此不做限制。
可以理解的是,无人机中相机的位置及角度会影响后续对目标进行定位的准确性。在至少有两台无人机(第一无人机和至少一台第二无人机)的相机对准了目标的情况下,该无人机中相机的位置及角度可能不太合适,因此,需要根据实际情况对已对准目标的无人机中相机的位置及角度进行调整。
作为一种实施方式,在至少有两台无人机(第一无人机和至少一台第二无人机)的相机对准目标的情况下,主机可以向对准目标的无人机发送调整指令:
具体的,向第一无人机发送第一调整指令,所述第一调整指令中携带有位置及角度数据,以使得所述第一无人机根据所述第一调整指令对自身相机的位置及角度进行调整;
向所述每台第二无人机分别发送第二调整指令,所述第二调整指令中携带有位置及角度数据,以使得所述每台第二无人机分别根据所接收到的第二调整指令对自身相机的位置及角度进行调整;其中,发送的每个第二调整指令中携带的数据相同或不同。
也就是说,根据实际情况向无人机发送调整指令,向不同无人机发送的调整指令中携带的位置及角度数据可能相同,可能不同。然后确定第一无人机及每台第二无人机调整后的相机的位置及角度数据。
当然,作为一种实施方式,第一无人机可以在其向主机发送对准目标的信息的同时,将自身相机的位置及角度数据一并发送给主机,但是在这种实施方式中,第一无人机将自身相机的位置及角度数据发送给主机后,不再对自身相机的位置及角度进行调整。
在本发明所示另一个实施例中,可以通过无人机对应的地面站对各台无人机进行控制,地面站控制下的无人机发现目标时,无人机可以将目标的大致位置、或者对准目标采集到的图像等等信息通过地面站转发给主机,主机将接收到的信息发送给其他地面站,以使其他地面站控制的无人机对准该目标并进行后续操作。
作为本发明的一种实施方式,S301可以为获得至少两台无人机中相机同时对准同一目标后的位置及角度数据。也就是说,多台无人机中的相机同时对准同一目标后,各台无人机将自身相机的位置及角度数据发送至主机,这样各台无人机发送的数据为同一时刻、针对同一目标的数据,数据更准确、更可靠。
S302:根据所获得的位置及角度数据,确定所述每台无人机中相机与所述目标之间的方向向量。
如图4a和4b所示,在相机的位置及角度为已知的情况下,便可以确定该相机与目标之间的方向向量。方向向量可以理解为以相机的位置坐标为起点、以相机的角度方向为延伸方向的射线。
S303:根据所确定的每个方向向量,确定所述目标的位置。
图4b中获得了两台无人机(第三无人机和第四无人机)中相机的位置及角度数据,并分别确定了这两台无人机中相机与目标之间的两个方向向量。图5b与图4b相对应,如图5b所示,将确定的这两个方向向量的交点确定为目标所在的位置。其中,A、B表示无人机所在位置,V1表示A位置的无人机(第三无人机)中相机与目标之间的方向向量(第一方向向量),V2表示B位置的无人机(第四无人机)中相机与目标之间的方向向量(第二方向向量),V1与V2的交点T即为目标所在位置。如果V1与V2未能交于一点,则将与这两个方向向量的距离之和最小的点确定为目标的位置。具体的,可以利用数据融合算法,比如最小二乘法、扩展卡尔曼滤波等算法确定一个点,该点与V1、V2这两个方向向量的距离之和最小,该点即为目标的位置。
图4a中获得了两台以上(三台)无人机中相机的位置及角度数据,并分别确定了这三台无人机中相机与目标之间的三个方向向量。图5a与图4a相对应,如图5a所示,将与这三个方向向量的距离之和最小的点确定为所述目标的位置。
假设确定了三个方向向量V1、V2和V3,如果这三个向量交于一点,该点与每个方向向量的距离都为0,距离之和也为0,该点即为目标的位置。如果这三个向量未能交于一点,则可以利用数据融合算法,比如最小二乘法、扩展卡尔曼滤波等算法确定一个点,该点与V1、V2、V3三个方向向量的距离之和最小,该点即为目标的位置。
需要说明的是,在图5b中,当A、B和T连线接近直线时,也就是当V1和V2角度接近180°或0°时,V1和V2本身的精度对目标位置的确定影响较大,这种情况下,确定目标位置准确性较低;当AT和BT接近直角时,V1和V2本身的精度对目标位置的确定影响较小,这种情况下,确定目标位置准确性较高。
因此,在上述实施方式中,根据实际情况对已对准目标的无人机中相机的位置及角度进行调整时,可以将无人机所在位置调整为上述AT和BT接近直角的情况,以提高对目标定位的准确性。
另外,确定的方向向量的数量越多,对目标的定位便越准确。因此,可以根据实际需求,确定主机调度的无人机的数量。
下面以一实例对本方案进行详细说明:
在本方案中可以先确定统一的坐标系,比如按照“北-东-地”的方位确定“X-Y-Z”笛卡尔坐标系。之后获得的相机的位置数据及角度数据都为该坐标系中的坐标数据。
假设获得了n台对准同一目标的无人机中相机的位置及角度数据,分别为(R1,P1)、(R2,P2)…(Rn,Pn)。其中,R表示相机的角度数据,这里可以为姿态信息,此处由3*3旋转矩阵为例进行说明,当R为单位矩阵时相机处于零姿态,这里假设相机零姿态时的朝向为竖直朝下,表示为单位向量V={0,0,1};P表示相机的位置数据。
根据上述n台无人机中相机的位置及角度数据,分别确定每个方向向量:
Vk=RkV={xvk,yvk,zvk},k=1,2……n(算式1)。
假设每台无人机中相机的位置坐标为Pk={xk,yk,zk},k=1,2……n(算式2)。
由算式1和算式2,求得方向向量Vk的表达式:0=akx+bky+ckz+dk,
其中,ak,bk,ck,dk为求得的方向向量Vk的参数,Vk为上述n台无人机中相机与目标之间的方向向量中的任意一个方向向量。
假设目标所在的坐标点为t={xt,yt,zt},则通过点到直线距离公式计算获得目标所在的坐标点到方向向量Vk的距离为:
lk=|akxt+bkyt+ckzt+dk|/(xt 2+yt 2+zt 2)1/2,k=1,2……n。
目标所在的坐标点到各方向向量的距离之和为:g(x,y,z)=l1+l2+……+ln,通过优化算法计算到各方向向量距离之和最小的点的坐标,也就是求函数g(x,y,z)为最小值时,目标所在的坐标点{xt,yt,zt}的值:
分别对x,y,z求g函数偏导并等于零,获得以下方程组:
求解以上方程组即可求得目标所在的坐标点{xt,yt,zt}的值。
如果确定了两个方向向量,则求解方程时可以加入约束条件l1=l2,即目标所在的坐标点到这两个方向向量的距离相等。
如果确定出目标所在的坐标点有多个,可以进一步对确定出的坐标点进行筛选,比如,可以将这些坐标点重新带入距离公式,针对每个坐标点,计算其到各个方向向量的距离,如果有多解可以将该坐标点剔除。另外,还可以利用优化算法提升精度,比如,针对每个坐标点,统计分析该点到各个方向向量的距离的概率分布情况,弃用一些导致协方差较大的方向向量,并根据剩余的方向向量重新计算目标点坐标。
应用本发明图3所示实施例,通过至少两台无人机对目标进行定位,根据该至少两台无人机中相机对准同一目标后的位置及角度数据,确定每台无人机中相机与目标之间的方向向量,根据所确定的方向向量,确定目标的位置,由此可见,在本方案中,根据多台无人机中相机的位置及角度数据确定目标所在位置,不需要利用三角法,也就不要求目标所在地面与无人机飞行位置正对地面位于同一海拔高度。也就是说,目标所在地面与无人机飞行位置正对地面的海拔高度差不影响目标定位的准确性,因此,应用本方案,提高了定位目标的准确性。
与上述的方法实施例相对应,本发明实施例还提供一种基于无人机的目标定位装置。
图6为本发明实施例提供的基于无人机的目标定位装置的第一种结构示意图,包括:
获得模块601,用于获得至少两台无人机中相机对准同一目标后的位置及角度数据;
第一确定模块602,用于根据所获得的位置及角度数据,确定所述每台无人机中相机与所述目标之间的方向向量;
第二确定模块603,用于根据所确定的每个方向向量,确定所述目标的位置。
在本实施例中,获得模块601,具体可以用于:
获得至少两台无人机中相机同时对准同一目标后的位置及角度数据。
作为本发明的一种实施方式,所述至少两台无人机中包括第一无人机和至少一台第二无人机;如图7所示,获得模块601,可以包括:接收子模块6011、第一发送子模块6012和确定子模块6013,其中,
接收子模块6011,用于接收所述第一无人机发送的对准目标的信息;
第一发送子模块6012,用于向每台第二无人机发送对准所述目标的指令;
确定子模块6013,用于在接收到所述每台第二无人机发送的对准所述目标的信息的情况下,确定所述第一无人机及所述每台第二无人机中相机的位置及角度数据。
在本实施例中,所述装置还可以包括:第二发送模块和第三发送模块(图中未示出),其中,
第二发送模块,用于在接收到所述每台第二无人机发送的对准所述目标的信息的情况下,向所述第一无人机发送第一调整指令,所述第一调整指令中携带有位置及角度数据,以使得所述第一无人机根据所述第一调整指令对自身相机的位置及角度进行调整;
第三发送模块,用于在接收到所述每台第二无人机发送的对准所述目标的信息的情况下,向所述每台第二无人机分别发送第二调整指令,所述第二调整指令中携带有位置及角度数据,以使得所述每台第二无人机分别根据所接收到的第二调整指令对自身相机的位置及角度进行调整;其中,发送的每个第二调整指令中携带的数据相同或不同;
确定子模块6013,具体可以用于:在接收到所述每台第二无人机发送的对准所述目标的信息的情况下,确定所述第一无人机及所述每台第二无人机调整后的相机的位置及角度数据。
在本实施例中,第二确定模块603,具体可以用于:
将与所确定的每个方向向量的距离之和最小的点确定为所述目标的位置。
在本实施例中,所述至少两台无人机中包括第三无人机和第四无人机;
第一确定模块601,具体可以用于:
根据所获得的所述第三无人机中相机的位置及角度数据,确定所述第三无人机中相机与所述目标之间的第一方向向量;
根据所获得的所述第四无人机中相机的位置及角度数据,确定所述第四无人机中相机与所述目标之间的第二方向向量;
第二确定模块603,具体可以用于:
确定所述第一方向向量与所述第二方向向量的交点为所述目标的位置。
应用本发明图6所示实施例,通过至少两台无人机对目标进行定位,根据该至少两台无人机中相机对准同一目标后的位置及角度数据,确定每台无人机中相机与目标之间的方向向量,根据所确定的方向向量,确定目标的位置,由此可见,在本方案中,不需要确定目标所在地面的海拔高度,也就是说,目标所在地面与无人机飞行位置正对地面的海拔高度差不影响目标定位的准确性,因此,应用本方案,提高了定位目标的准确性。
本发明实施例还提供一种基于无人机的目标定位系统,如图2所示,包括:至少两台无人机(无人机1、无人机2……无人机n)、至少两个地面站(地面站1、地面站2……地面站n)以及一个主机,其中,地面站与无人机一一对应。
所述无人机,用于将自身相机对准目标;检测所述相机的位置及角度数据;将所述数据发送给自身对应的地面站;
所述地面站,用于接收无人机发送的所述数据,将所述数据发送给所述主机;
所述主机中设置有本发明所示实施例中任一项目标定位装置。
作为一种实施方式,所述主机可以设置于任一地面站,也可以设置于任一无人机。当然,主机还可以为独立存在的计算机、平板电脑、手机等电子设备,在此不做限制。
在本发明所示实施例中,主机可以对多台无人机进行航线及目标的设定,当然,各地面站也可以对自身控制下的无人机进行航线及目标的设定,使这些无人机按照设定的航线飞行,并且在飞行过程中,对地面区域进行扫描监视。当扫描到设定的目标时,无人机将自身相机对准目标,并获得自身相机的位置及角度数据。
无人机将获得的自身相机的位置及角度数据发送给地面站,由地面站转发给主机。
主机接收到各台无人机中相机的位置及角度数据,根据这些数据,确定每台无人机中相机与目标之间的方向向量(无人机与地面站一一对应,这里也可以是每个地面站对应的方向向量),根据所确定的每个方向向量,确定目标的位置。
应用本实施例,通过至少两台无人机对目标进行定位,根据该至少两台无人机中相机对准同一目标后的位置及角度数据,确定每台无人机中相机与目标之间的方向向量,根据所确定的方向向量,确定目标的位置,由此可见,在本方案中,根据多台无人机中相机的位置及角度数据确定目标所在位置,不需要利用三角法,也就不要求目标所在地面与无人机飞行位置正对地面位于同一海拔高度。也就是说,目标所在地面与无人机飞行位置正对地面的海拔高度差不影响目标定位的准确性,因此,应用本方案,提高了定位目标的准确性。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
本说明书中的各个实施例均采用相关的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。尤其,对于装置实施例而言,由于其基本相似于方法实施例,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。
本领域普通技术人员可以理解实现上述方法实施方式中的全部或部分步骤是可以通过程序来指令相关的硬件来完成,所述的程序可以存储于计算机可读取存储介质中,这里所称得的存储介质,如:ROM/RAM、磁碟、光盘等。
以上所述仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进等,均包含在本发明的保护范围内。