无人机三自由度空中自主加油装置的制造方法
【专利摘要】本实用新型是一种无人机三自由度空中自主加油装置，用于模拟无人机空中加油半物理仿真平台中两个八旋翼无人机的模拟加油仿真。本实用新型旨在加油机获得受油机的成像后，通过无人机安装的英特尔NUC微型计算机(以下简称NUC)模块，利用其内在视觉处理程序解算出两机之间位姿关系，然后通过通信协议传输给加油杆装置中的单片机模块。单片机模块完成输出信息，驱动，执行指令，最终将加油杆以正确角度和姿态朝向受油机，为最终对接提供支持。
【专利说明】无人机三自由度空中自主加油装置 【技术领域】
[0001]本发明涉及一种无人机三自由度空中自主加油装置，属于自动化技术领域。 【【背景技术】】
[0002] 空中加油技术是提高飞机远程作战效能的关键技术之一，是增强战斗力的放大 器。空中加油不仅改变了以往的作战模式，而且还可以提高战绩的综合作战效能，已成为先 进军用飞机完成作战任务不可缺少的保障措施。相对于软管式加油，硬管式空中加油因为 加油量大、受油机操作负担轻、受油机受油设备简单而具有明显的优势，因而成为未来空中 加油技术的发展方向。近年来，无人机的自主空中加油更是成为了自动化研究领域的一个 热点。
[0003] 加油杆装置是硬式空中加油的核心设备之一，当前环境对于无人机自主空中加油 半物理验证设备中对于加油杆的模型装置缺乏研究成果，本发明旨在提出一种无人机三自 由度空中自主加油装置，装置还拥有重量轻、机械结构强度高、实时性强等特点。可以用于 无人机之间的空中加油试验验证，对于今后研究无人机空中加油问题有很好的拓展强度， 具有良好的应用前景。 【
【发明内容】
】
[0004] 本发明是一种无人机三自由度空中自主加油装置，用于模拟无人机空中加油半物 理仿真平台中两个八旋翼无人机的模拟加油仿真。该发明旨在加油机获得受油机的成像 后，通过无人机安装的英特尔NUC微型计算机（以下简称NUC)模块，利用其内在视觉处理程 序解算出两机之间位姿关系，然后通过通信协议传输给加油杆装置中的单片机模块。单片 机模块完成输出信息，驱动，执行指令，最终将加油杆以正确角度和姿态朝向受油机，为最 终对接提供支持。
[0005] 本装置分为机械结构和控制系统两部分。
[0006] 机械结构包括一个机械平台、一根可以二截伸缩的加油杆、三个舵机、两个摄像机 和一个摄像机安装架。机械平台用于固定安装电源、NUC、单片机模块和阻尼模块。机械平台 下方安装悬挂加油杆，加油杆可以二截伸缩，长度约为2米，直径从6mm至16mm，中空结构。三 个舵机中每个舵机控制一个自由度，并相应配套舵盘完成机械运动，其中两个第一舵盘行 程为90度，用于控制加油杆的偏航和俯仰运动，一个第二舵盘行程为720度，用于完成加油 杆的伸缩运动。
[0007] 单片机模块用于接收无人机NUC模块解算的两个无人机之间的视觉测量结果，通 过单片机模块的计算单元处理形成舵机指令，执行机构将舵机指令传输给舵机完成相应指 令。
[0008] 阻尼模块，包括两个阻尼杆，主要对加油杆三个自由度运动起到阻尼作用，一根外 径6mm，1米长的阻尼杆内嵌于加油杆，对加油杆伸缩起到阻尼作用，另有一根阻尼杆的两端 分别通过螺钉固定于机械平台上片和加油杆，对加油杆的偏航俯仰运动起到阻尼作用。
[0009] 所述的3个舵机采用相互垂直的安装方式，旨在分别完成加油杆的偏航、俯仰和伸 缩运动，两个第一舵盘为U字型，开口端分别固定在偏航和俯仰舵机上并且所在平面相互垂 直，各自完成对相应自由度的控制，第二舵盘为圆盘形，固定在伸缩舵机上，完成加油杆的 伸缩自由度的控制。最终，加油杆能够达到在一个近似于四分之一球面的位置运动伸缩，为 两架无人机的空中加油验证提供便利。
[0010] 所述的摄像机安装架为T字型，倒装在机械平台下方，两端以中间对称分别各安装 一个摄像机，用于采集无人机当前航拍的图像。图像通过通信机构传输给NUC模块，就能完 成视觉信息解算，得到无人机与加油机的位置姿态。
[0011] 控制系统包括位姿信息处理单元、舵机控制单元和电源单元。
[0012] 所述电源单元为整个硬件系统提供电源；
[0013] 所述位姿信息处理单元负责对无人机中NUC利用视觉信息算法处理得到的位姿关 系进行处理，得到舵机的动作指令；
[0014] 所述舵机控制单元负责将先前舵机动作指令转换成舵盘旋转角度，带动舵盘完成 相应动作。
[0015] 所述位姿信息处理单元和舵机控制单元的控制方式为自动运行，根据用户内置的 控制率，在加油机和受油机飞行期间，可将两者之间的实时相对位置姿态解算成舵机控制 指令最终完成加油杆的对准。
[0016] 具体工作步骤如下：
[0017] (1)加油杆初始状态为受到阻尼杆拉力的自然下垂状态。当无人机中的NUC将视觉 解算结果（即两个无人机的坐标转换关系，为一个旋转矩阵R和一个平移矩阵T)通过串口通 信传输给单片机模块，单片机模块利用两机之间的相对距离求得加油杆相当于飞行平面所 需调整的角度。
[0018] (2)舵盘角度已经由其内置机构决定，将舵盘的行程角度转换成0到2500的编码。 在得到上述角度信息后，单片机模块的位姿信息处理单元将转换得到的编码传输给舵机控 制单元，再由控制单元带动舵机进行动作。为了防止舵机运动过快造成的不稳定现象，本装 置采用了在舵机控制单元增加延迟机构以及安装阻尼杆的双重方式在基本保障实时性的 条件下消除振荡。
[0019] 本发明优点以及功效在于：
[0020] 采用一种可在无人机飞行过程中实现加油杆自动控制对准的模型，可以实现在无 人机(加油机和受油机)空中加油半物理仿真过程中，加油杆对加油口目标进行对准，克服 必须让两个无人机精确到某一固定位置才能实现对接的局限性。本装置还拥有重量轻、机 械结构强度高、实时性强等特点。对于今后研究无人机空中加油问题有很好的拓展强度。 【【附图说明】】
[0021] 图1为无人机三自由度空中自主加油装置结构示意图。
[0022] 图2为无人机三自由度空中自主加油装置底部示意图。
[0023]图3为无人机三自由度空中自主加油装置底部示意图。
[0024]图4为加油杆内部关系示意图。
[0025]图5为硬件连接关系示意图。
[0026]图6为加油杆位姿关系。
[0027]图中序号、标号、代号说明如下：
[0028] 1、电源 2、英特尔微型计算机NUC(Next Unit Computing)模块
[0029] 3、平台上片 4、单片机模块 5、摄像机
[0030] 6、摄像机安装架 7、舵机 8、加油杆
[0031] 9、第一阻尼杆 10、平台下片 11、舵机安装架
[0032] 12、第一舵盘 13、第二舵盘 14、第二阻尼杆 【【具体实施方式】】
[0033]请参阅图1 一6所示，本发明是一种无人机三自由度空中自主加油装置，它分为机 械结构和控制系统两部分。机械结构采用经典的分层式左右对称结构，整体可分为上层控 制率处理结构和下层加油杆控制结构，使其具备伺服控制，并有较好的精确度指标。
[0034] 本发明用于模拟无人机空中加油半物理仿真平台中两个八旋翼无人机的模拟加 油仿真。该发明旨在加油机获得受油机的成像后，通过无人机安装的NUC模块，利用其内在 视觉处理程序解算出两机之间位姿关系，然后通过通信协议传输给加油杆装置中的单片机 模块。单片机模块完成输出信息，驱动，执行指令，最终将加油杆以正确角度、姿态朝向受油 机，为最终对接提供支持。本装置分为机械结构和控制系统两部分。
[0035] 机械结构包括一个机械平台、一根可以二截伸缩的加油杆、三个舵机、两个摄像机 和一个摄像机安装架。机械平台分为平台上片3和平台下片10,平台上片上方用于固定安装 电源I、NUC2;下方用于安装摄像机安装架6，安装架左右对称安装两个摄像机5。平台下片用 于安装单片机模块4等元件。平台下方悬挂安装根可以二截伸缩的加油杆8,加油杆的长度 约为2米，直径从6mm至16mm，中空结构。三个舵机（图中仅标注7)安装在安装架上（图中仅标 注11)，每个舵机控制一个自由度，并相应配套舵盘完成机械运动，其中两个第一舵盘12行 程为90度，用于控制加油杆的偏航和俯仰运动，一个第二舵盘13行程为720度，用于完成加 油杆的伸缩运动。
[0036] 单片机模块用于接收无人机NUC模块解算的两个无人机之间的视觉测量结果，通 过其计算单元处理形成舵机指令，执行机构将舵机指令传输给舵机完成相应指令。
[0037]阻尼模块包括两个阻尼杆，主要对加油杆三个自由度运动起到阻尼作用，一根外 径6mm，1米长的阻尼杆14内嵌于加油杆，对加油杆伸缩起到阻尼作用，另有一根弹簧9两端 分别通过螺钉固定于机械平台上片和加油杆，对加油杆的偏航和俯仰运动起到阻尼作用。
[0038] 所述的3个舵机采用相互垂直的安装方式，旨在分别完成加油杆的偏航、俯仰和伸 缩运动，两个第一舵盘为U字型，开口端分别固定在偏航和俯仰舵机上并且所在平面相互垂 直，各自完成对相应自由度的控制，第二舵盘为圆盘形，固定在伸缩舵机上，完成加油杆的 伸缩自由度的控制。最终，加油杆能够达到在一个近似于四分之一球面的位置运动伸缩，为 两架无人机的空中加油验证提供便利。
[0039] 所述的摄像机安装架为T字型，倒装在机械平台下方，两端以中间对称分别各安装 一个摄像机，用于采集无人机当前航拍的图像。图像通过通信机构传输给NUC模块，就能完 成视觉信息解算，得到无人机与加油机的位置姿态。
[0040] 控制系统包括位姿信息处理单元、舵机控制单元和电源单元。所述电源单元为整 个硬件系统提供电源，位姿信息处理单元负责对无人机视觉信息处理得到的位姿关系进行 处理得到舵机的动作指令。所述舵机控制单元负责将先前舵机动作指令转换成舵盘旋转角 度，带动舵盘完成相应动作。
[0041]上述位姿信息处理单元和舵机控制单元的控制方式为自动运行，根据用户内置的 控制率，在加油机和受油机飞行期间，可将两者之间的实时相对位置姿态解算成舵机控制 指令最终完成加油杆的对准。
[0042] 具体工作步骤如下：
[0043] (1)加油杆初始状态为受到阻尼杆拉力的自然下垂状态。当无人机NUC将视觉解算 结果（即两个无人机的坐标转换关系，为一个旋转矩阵R和一个平移矩阵T)通过串口通信传 输给单片机模块位姿信息处理单元，单片机模块利用两机之间的相对距离求得加油杆相当 于飞行平面所需调整的角度。具体方式如下：
[0044] 1.按照图6方式对加油杆进行建模，红色AB、BC为二自由度舵机组的舵面，AB是控 制偏航的舵面，BC为控制俯仰的舵面。蓝色CO为加油杆，CO垂直于BC。
[0045] 2.已知杆的状态，求解空间坐标
[0046]分别以A、B、C三点为原点建立"前一右一下"三个坐标系。设加油杆长为L，则0点在 C系下的坐标为，偏航角为Φ，俯仰角为0，现求解0点在A下的坐标。
[0047] 为求得0点在A系下坐标，需将C系依次变换到B系、A系，即Xc-Xb-XaA.Xc-Xb
[0048] 设C系到B系旋转矩阵为Rcb，位移矩阵为Tcb X系绕Yc轴旋转-Θ，再平移向量Tcb，得 至IjB系
[0049]
[0050]
[0051 ] _____ -一
[0052] 设B系到A系旋转矩阵为Rba，位移矩阵为TBA』系绕Za轴旋转-Φ，再平移向量TBA，得 到A系
[0053]
[0054]
[0055]
[0056] Xs为舵机组坐标系原点，将A系平移向量Tas即可得到0系
[0059] 综上，由（1)-(3)式可得加油杆端点0在S系下坐标为[0060] Xs = RbaRcbXc+RbaT cb+T ba+Tas (4)
[0057]
[0058] 5)
[0066] 0点在C系下坐标为乂。(0)=仏，0,0)\在3系下坐标为乂5(0) = (^，75，^)\代入式 (7)可得 (7)
[0067] (B)
[0068] 3.加油杆位姿关糸逆解
[0069] 本发明中，由视觉算法测量解算受油口相对加油机的空间坐标，该坐标经过坐标 变换可得到加油杆端点〇的目标位置Xs(O)。因此，需要由Xs(O)推算出杆的位姿关系
[0070] A ·加油杆的长度L
[0071] 由于L相比于从A系到S系的位移矩阵中每个参数大很多，可近似将杆的另外一个 端点移到S系原点，则
[0072]
(S)
[0073] B.加油杆俯仰角Θ
[0074] -〇)
[0075]
[0076] (,11.)
[0077] 由上述推导，就能得到加油杆需要的俯仰、偏航角度以及杆的距离参数。之后就可 以通过通信协议将这些指令传输给舵机控制单元。
[0078] (2)舵盘角度已经由其内置机构决定，将舵盘的行程角度转换成0到2500的编码。 在得到上述角度信息后，单片机模块的位姿信息处理单元将转换得到的编码传输给舵机控 制单元，再由控制单元带动舵机进行动作。为了防止舵机运动过快造成的不稳定现象，本装 置采用了在舵机控制单元增加延迟机构以及安装阻尼杆的双重方式在基本保障实时性的 条件下消除振荡。
【主权项】
1. 一种无人机三自由度空中自主加油装置，其特征在于：该装置分为机械结构和控制 系统两部分;机械机构部分包括： 所述机械结构包括一个机械平台、加油杆、三个舵机、两个摄像机和一个摄像机安装 架； 所述机械平台用于固定安装电源、英特尔微型计算机NUC、单片机模块和阻尼模块;机 械平台下方安装悬挂加油杆;所述三个舵机中每个舵机控制一个自由度，并相应配套舵盘 完成机械运动;三个舵机采用相互垂直的安装方式，分别完成加油杆的偏航、俯仰和伸缩运 动； 所述舵盘分为两个第一舵盘和一个第二舵盘;两个第一舵盘为U字型，开口端分别固定 在偏航和俯仰舵机上并且所在平面相互垂直，各自完成对相应自由度的控制;第二舵盘为 圆盘形，固定在伸缩舵机上，完成加油杆的伸缩自由度的控制； 所述单片机模块用于接收无人机NUC模块解算的两个无人机之间的视觉测量结果，通 过单片机模块的计算单元处理形成舵机指令，执行机构将舵机指令传输给舵机完成相应指 令； 所述阻尼模块包括两个阻尼杆，对加油杆三个自由度运动起到阻尼作用； 所述的摄像机安装架为T字型，倒装在机械平台下方，两端以中间对称分别各安装一个 摄像机，用于采集无人机当前航拍的图像；图像通过通信机构传输给NUC模块，完成视觉信 息解算，得到无人机与加油机的位置姿态； 机械机构部分包括:位姿信息处理单元、舵机控制单元和电源单元； 所述位姿信息处理单元负责对无人机中NUC模块利用视觉信息算法处理得到的位姿关 系进行处理，得到舵机的动作指令； 所述舵机控制单元负责将先前舵机动作指令转换成舵盘旋转角度，带动舵盘完成相应 动作； 所述电源单元为整个硬件系统提供电源。2. 根据权利要求1所述的无人机三自由度空中自主加油装置，其特征在于:所述加油杆 能二截伸缩，长度为2米，直径从6mm至16mm，为中空结构。3. 根据权利要求1所述的无人机三自由度空中自主加油装置，其特征在于:所述两个第 一舵盘行程为90度，用于控制加油杆的偏航和俯仰运动，一个第二舵盘行程为720度，用于 完成加油杆的伸缩运动。4. 根据权利要求1所述的无人机三自由度空中自主加油装置，其特征在于:所述两个阻 尼杆分为第一阻尼杆和第二阻尼杆;第二阻尼杆外径6mm，长度1米，内嵌于加油杆中，对加 油杆伸缩起到阻尼作用；第一阻尼杆的两端分别通过螺钉固定于机械平台上片和加油杆， 对加油杆的偏航俯仰运动起到阻尼作用。5. 根据权利要求1所述的无人机三自由度空中自主加油装置，其特征在于:所述位姿信 息处理单元和舵机控制单元的控制方式为自动运行，根据用户内置的控制率，在加油机和 受油机飞行期间，将两者之间的实时相对位置姿态解算成舵机控制指令最终完成加油杆的 对准。
【文档编号】G05D1/08GK205427620SQ201620194445
【公开日】2016年8月3日
【申请日】2016年3月14日
【发明人】段海滨, 许衍, 张聪, 罗琪楠
【申请人】北京航空航天大学