基于TOF的无人机及其机群在飞行中队形保持和变队的方法技术

本发明专利技术涉及无人机领域，特别涉及基于TOF的无人机及其机群在飞行中队形保持和变队的方法，本发明专利技术基于TOF的无人机及其机群在飞行中队形保持和变队的方法采用僚机的TOF摄像头对长机拍摄，获取长机深度图像信息，进而获取僚机和长机的实际位置关系，通过飞行控制模块控制僚机位置解决了无人机机群在飞行时队形保持和变队时处理速度慢、对环境光线依赖高、精度低的问题。本发明专利技术适用于无人机。本发明专利技术适用于无人机。本发明专利技术适用于无人机。

【技术实现步骤摘要】
基于TOF的无人机及其机群在飞行中队形保持和变队的方法


[0001]本专利技术涉及无人机领域，特别涉及基于TOF的无人机及其机群在飞行中队形保持和变队 的方法。

技术介绍

[0002]近两年，无人机机群飞行将文字、造型、LOGO等在空中呈现可谓是最火爆的表演秀，它 特有的科技感、强可塑性、艺术性受到了众多晚会节目、发布会、活动现场、景区表演、婚 礼现场的青睐。它的可定制化满足大众想要独一无二的专属表演的需求，同时不停的推陈出 新，适应市场的快速发展，将前沿科技的魅力展现的淋漓尽致。而无人机编队飞行过程中如 何保持队形和如何变队形是无人机技术必不可少的组成部分，同时无人机群往往处于未知的 动态环境中，这就要求无人机机群在飞行时具有自适应性和多变性。
[0003]TOF是Time of flight的简写，飞行时间法3D成像，是通过给目标连续发送光脉冲， 然后利用传感器接收从物体返回的光，通过探测光脉冲的飞行时间来得到目标物的距离。

技术实现思路

[0004]本专利技术所解决的技术问题：提供基于TOF的无人机及其机群在飞行中队形保持和变队的 方法实现无人机机群在飞行时队形保持和变队时处理速度慢、对环境光线依赖高、精度低的 问题。
[0005]本专利技术解决上述技术问题采用的技术方案：无人机包括多个TOF摄像头、TOF判断模块、 TOF控制模块和飞行控制模块，所述多个TOF摄像头分别和TOF判断模块相连，所述TOF判 断模块，TOF控制模块和飞行控制模块顺次连接，所述多个TOF摄像头选择合适的FOV能实 现无人机720
°
视野全覆盖进行拍照，用于采集位置信息；所述TOF判断模块用于计算相对 位置变化，比较预设位置信息和当前位置信息，并将位置差值数据发送到TOF控制模块；TOF 控制模块解析位置差值数据，通过飞行控制模块控制无人机进行水平方向、前后方向和竖直 方向的位置调节。
[0006]进一步的，多个TOF摄像头是四个，一个位于机身顶部，一个位于机身腹部处，一个位 于机身左部，一个位于机身右部。
[0007]进一步的，无人机还包括无线接收模块，所述无线接收模块与TOF判断模块相连，用于 接收变队后的位置关系信息。
[0008]无人机群飞行时队形保持的方法，包括以下步骤：
[0009]S01、机群中选择一架无人机做为长机，其余无人机做为僚机；设置僚机和长机之间的相 对位置关系作为预设位置信息；
[0010]S02、僚机上的TOF摄像头每隔一段时间拍摄多组长机的图像信息，并转换成深度图，通 过多组长机的深度图平均值，获得僚机和长机的实际位置关系；
[0011]S03、僚机上的TOF判断模块比较实际位置关系和预设位置关系，如果实际位置关
系和预 设位置相等，则保持僚机飞行状态，如果际位置关系和预设位置不相等，则计算僚机位置偏 移量；
[0012]S04、僚机上的TOF控制模块根据偏移量通过飞行控制模块调整当前僚机的位置。
[0013]进一步的，步骤S03中，获取僚机位置偏移量的计算公式是： Z＝L
‑
L',其中P表示僚 机的水平方向偏移量，Q表示僚机的竖直方向偏移量，Z表示僚机的前后方向偏移量，预设位 置信息中：长机在深度图中的坐标是(U,V)、僚机和长机之间的距离是L，实际位置关系中： 长机在深度图中的坐标是(U',V')、僚机和长机之间的距离是L'，TOF摄像头像素是x
×
y， w表示垂直FOV，r表示水平FOV。
[0014]无人机群飞行时变队形的方法，包括以下步骤：
[0015]S501、机群中选择一架无人机做为长机，其余无人机做为僚机；
[0016]S502、僚机上的无线接收模块接收变队形后的位置关系；
[0017]S503、僚机上的TOF判断模块将无线接收模块接收的位置关系作为预设位置关系；
[0018]S504、僚机上的TOF摄像头每隔一段时间拍摄多组长机的图像信息，并转换成深度图， 通过多组长机的深度图平均值，获得僚机和长机的实际位置关系；
[0019]S505、僚机上的TOF判断模块比较实际位置关系和预设位置关系，如果实际位置关系和 预设位置相等，则保持僚机飞行状态，如果际位置关系和预设位置不相等，则计算僚机位置 偏移量；
[0020]S506、僚机上的TOF控制模块根据偏移量通过飞行控制模块调整当前僚机的位置。
[0021]本专利技术的有益效果：本专利技术基于TOF的无人机及其机群在飞行中队形保持和变队的方法 采用僚机的TOF摄像头对长机拍摄，获取长机深度图像信息，进而获取僚机和长机的实际位 置关系，通过飞行控制模块控制僚机位置解决了无人机机群在飞行时队形保持和变队时处理 速度慢、对环境光线依赖高、精度低的问题。本专利技术具有容易实施，成本低的优点。
附图说明
[0022]图1是本专利技术基于TOF的无人机及其机群在飞行中队形保持和变队的方法根据深度图计 算偏移量的部分参数示意图。
[0023]图2是本专利技术基于TOF的无人机及其机群在飞行中队形保持和变队的方法的飞行中队形 保持流程图。
[0024]附图说明：L表示僚机和长机之间的距离，w表示垂直FOV，r表示水平FOV，x
×
y表示 TOF摄像头的像素。
具体实施方式
[0025]本专利技术提供基于TOF的无人机及其机群在飞行中队形保持和变队的方法实现无人机机群 在飞行时队形保持和变队时处理速度慢、对环境光线依赖高、精度低的问题，包括无人机、 无人机机群在飞行中队形保持的方法和无人机机群在飞行中变队的方法。
[0026]无人机包括多个TOF摄像头、TOF判断模块、TOF控制模块和飞行控制模块，所述多个TOF 摄像头分别和TOF判断模块相连，所述TOF判断模块，TOF控制模块和飞行控制模块顺次连 接，所述多个TOF摄像头选择合适的FOV能实现无人机720
°
视野全覆盖进行拍照，用于采 集位置信息；所述TOF判断模块用于计算相对位置变化，比较预设位置信息和当前位置信息， 并将位置差值数据发送到TOF控制模块；TOF控制模块解析位置差值数据，通过飞行控制模 块控制无人机进行水平方向、前后方向和竖直方向的位置调节。
[0027]进一步的，多个TOF摄像头是四个，一个位于机身顶部，一个位于机身腹部处，一个位 于机身左部，一个位于机身右部。
[0028]进一步的，无人机还包括无线接收模块，所述无线接收模块与TOF判断模块相连，用于 接收变队后的位置关系信息。
[0029]无人机群飞行时队形保持的方法，包括以下步骤：
[0030]S01、机群中选择一架无人机做为长机，其余无人机做为僚机；设置僚机和长机之间的相 对位置关系作为预设位置信息；
[0031]S02、僚机上的TOF摄像头每隔一段时间拍摄多组长机的图像信息，并转换成深度图，通 过多组长机的深度图平均值，获得僚机和长机的实际位置关系本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.无人机，其特征在于，包括多个TOF摄像头、TOF判断模块、TOF控制模块和飞行控制模块，所述多个TOF摄像头分别和TOF判断模块相连，所述TOF判断模块，TOF控制模块和飞行控制模块顺次连接，所述多个TOF摄像头选择合适的FOV能实现无人机720
°
视野全覆盖进行拍照，用于采集位置信息；所述TOF判断模块用于计算相对位置变化，比较预设位置信息和当前位置信息，并将位置差值数据发送到TOF控制模块；TOF控制模块解析位置差值数据，通过飞行控制模块控制无人机进行水平方向、前后方向和竖直方向的位置调节。2.根据权利要求1所述的无人机，其特征在于，所述多个TOF摄像头是四个，一个位于机身顶部，一个位于机身腹部处，一个位于机身左部，一个位于机身右部。3.根据权利要求1所述的无人机，其特征在于，还包括无线接收模块，所述无线接收模块与TOF判断模块相连，用于接收变队后的位置关系信息。4.无人机群飞行时队形保持的方法，应用于权利要求1或2或3所述的无人机组成的无人机群，其特征在于，包括以下步骤：S01、机群中选择一架无人机做为长机，其余无人机做为僚机；设置僚机和长机之间的相对位置关系作为预设位置信息；S02、僚机上的TOF摄像头每隔一段时间拍摄多组长机的图像信息，并转换成深度图，通过多组长机的深度图平均值，获得僚机和长机的实际位置关系；S03、僚机上的TOF判断模块比较实际位置关系和预设位置关系，如果实际位置关系和预设位置相等，则保持僚机飞行状态，如果际位置关系和预设位置不相等，...

【专利技术属性】
技术研发人员：胡淼，赵意成，李华，
申请(专利权)人：四川长虹电器股份有限公司，
类型：发明
国别省市：