(12)发明专利申请
(10)申请公布号 CN 111924101 A(43)申请公布日 2020.11.13
(21)申请号 202010894040.0(22)申请日 2020.08.31
(71)申请人 金陵科技学院
地址 211169 江苏省南京市江宁区弘景大
道99号(72)发明人 高英杰 叶全意 陈宁 洪剑方 (74)专利代理机构 南京钟山专利代理有限公司
32252
代理人 徐博(51)Int.Cl.
B64C 39/02(2006.01)B64D 47/08(2006.01)
权利要求书2页 说明书5页 附图6页
(54)发明名称
一种无人机双云台相机及其工作方法(57)摘要
本发明公开了一种无人机双云台相机及其工作方法，包括以下步骤：获取多光谱相机拍照点的经纬度并转换为UTM坐标；根据多光谱相机拍照点的UTM坐标计算得出可疑目标位置的UTM坐标；根据多光谱相机拍照点和可疑目标位置的UTM坐标计算在飞机悬停点时第二云台的俯仰角和方位角，然后对可疑目标位置进行高分RGB拍摄。本发明避免了多光谱相机对光谱相近的植物或物体进行误识别的情况，提高了无人机巡检的精准度和可靠性。
CN 111924101 ACN 111924101 A
权 利 要 求 书
1/2页
1.一种无人机双云台相机，其特征在于，包括无人机机体，所述无人机的机体上设有第一云台和第二云台，所述第一云台上设有A相机，所述的A相机用于通过内置热红外或光谱算法高效识别可疑目标，所述第二云台上设有可见光相机。
2.一种无人机双云台相机的工作方法，应用权利要求1所述的无人机双云台相机，其特征在于，包括以下步骤：
获取A相机拍照点的经纬度并转换为UTM坐标；
根据A相机拍照点的UTM坐标计算得出可疑目标位置的UTM坐标；
根据A相机拍照点和可疑目标位置的UTM坐标计算在飞机悬停点时第二云台的俯仰角和方位角，然后对可疑目标位置进行高分RGB拍摄。
3.根据权利要求2所述的无人机双云台相机的工作方法，其特征在于，所述根据A相机拍照点的UTM坐标计算得出可疑目标位置的UTM坐标具体包括以下步骤：
设A相机拍照点的UTM坐标为(XA,YA)，以飞机飞行方向为y轴，垂直于飞机飞行的方向为x轴，A相机拍照点为原点建立坐标系xAy；
以正北为y’轴，正东为x’轴，建立坐标系x’Ay’,计算可疑目标位置在x’Ay’中的坐标，计算公式为：
x’θθB＝(n-640)*d*cos1+(m-480)*d*sin1；y’θθB＝(m-480)*d*cos1-(n-640)*d*sin1；其中，θ正北为0°，范围为0°～360°，顺时针为正方向，m，1为A相机拍照点对应的航向角，
n分别为可疑目标位置在坐标系xAy的栅格行坐标和栅格列坐标，d为空间分辨率；
计算可疑目标位置的UTM坐标，计算公式为：XB＝XA+x’B；YB＝YA+y’B。
4.根据权利要求2所述的无人机双云台相机的工作方法，其特征在于，根据A相机拍照点和可疑目标位置的UTM坐标计算在飞机悬停点时第二云台的俯仰角包括以下步骤：
记可疑目标位置为B点，无人机悬停点为D点，无人机悬停点的星下点为C点，无人机悬停点对应的航向角为θC点的UTM坐标(XC，YC)；2，
以C点为原点，正北为Y轴，正东为X轴，建立坐标系XCY，得到可疑目标位置在XCY下的坐标为X’Y’无人机悬停点D点在坐标系XCY下的坐标为(0，0，hD)，hD为高度；B＝XB-XC，B＝YB-YC；
定义无人机悬停点到可疑目标位置之间的向量停点到星下点的向量
为(XB-XC，YB-YC，-hD)，定义无人机悬
与
的夹角；
为(0，0，-hD)；则第二云台的俯仰角α为向量
计算第二云台的俯仰角α，计算公式为：
其中，α的取值范围为0°～90°；
定义可见光相机的俯仰角定义为水平时为0°，向上旋转为正，向下旋转为负，得到第二云台的俯仰角Pitch＝α-90°，其中，Pitch的角度范围为-90°～0°。
5.根据权利要求4所述的无人机双云台相机的工作方法，其特征在于，根据A相机拍照
2
CN 111924101 A
权 利 要 求 书
则
2/2页
点和可疑目标位置的UTM坐标计算在飞机悬停点时第二云台的方位角包括以下步骤：
定义星下点到可疑目标位置之间的向量向的夹角β的余弦为：
与正北方
其中，β的取值范围为0°-180°；
定义第二云台方位角为朝向机身正前方方向时为0°，顺时针旋转为正，逆时针旋转为负；以正北方向为0°，顺时针旋转为正建立方位角坐标系，得到向量β′在方位角坐标系下的表达式：(XB-XC)≥0时，β’＝β(XB-XC)<0时，β’＝360-β其中，β’的取值范围为0°-360°；计算第二云台的方位角，计算公式为：Yaw＝β’-θ2其中，Yaw的取值范围为0°-360°。
与正北方向的夹角
3
CN 111924101 A
说 明 书
一种无人机双云台相机及其工作方法
1/5页
技术领域
[0001]本发明属于无人机云台控制技术领域，具体涉及一种无人机双云台相机及其工作方法。
背景技术
[0002]无人机在巡检过程中，针对一些特定的场景，只使用单一的可见光相机，巡检效率低，无法实现一些专业的需求，例如在60米高空快速地识别地面的的罂粟，则需要多光谱相机进行大面积的筛查，通过罂粟的特定光谱反射特征来判定该区域是否存在罂粟，然后通过可见光相机变焦查看罂粟的细节图像，核查确认该区域是否存在罂粟。[0003]现有技术中存在一些双光的多光谱加可见光相机，但由于硬件的原因导致可见光相机部分无法快速变焦，查看多光谱相机捕捉到的目标图像细节。发明内容
[0004]本发明针对现有技术中的不足，提供一种无人机双云台相机及其工作方法，实现了多光谱相机和可见光相机在同一架无人机上的协同工作，避免了多光谱相机误识别的情况。
[0005]为实现上述目的，本发明采用以下技术方案：[0006]一种无人机双云台相机，包括无人机机体，所述无人机的机体上设有第一云台和第二云台，所述第一云台上设有A相机，所述的A相机用于通过内置热红外或光谱算法高效识别可疑目标，所述第二云台上设有可见光相机。[0007]一种无人机双云台相机的工作方法，应用上述的无人机双云台相机，包括以下步骤：
[0008]获取A相机拍照点的经纬度并转换为UTM坐标；
[0009]根据A相机拍照点的UTM坐标计算得出可疑目标位置的UTM坐标；
[0010]根据A相机拍照点和可疑目标位置的UTM坐标计算在飞机悬停点时第二云台的俯仰角和方位角，然后对可疑目标位置进行高分RGB拍摄。[0011]为优化上述技术方案，采取的具体措施还包括：[0012]进一步地，上述根据A相机拍照点的UTM坐标计算得出可疑目标位置的UTM坐标具体包括以下步骤：
[0013]设A相机拍照点的UTM坐标为(XA,YA)，以飞机飞行方向为y轴，垂直于飞机飞行的方向为x轴，A相机拍照点为原点建立坐标系xAy；[0014]以正北为y’轴，正东为x’轴，建立坐标系x’Ay’,计算可疑目标位置在x’Ay’中的坐标，计算公式为：[0015]x’θθB＝(n-640)*d*cos1+(m-480)*d*sin1；[0016]y’θθB＝(m-480)*d*cos1-(n-640)*d*sin1；[0017]其中，θ正北为0°，范围为0°～360°，顺时针为正方1为A相机拍照点对应的航向角，
4
CN 111924101 A
说 明 书
2/5页
向，m，n分别为可疑目标位置在坐标系xAy的栅格行坐标和栅格列坐标，d为空间分辨率；[0018]计算可疑目标位置的UTM坐标，计算公式为：[0019]XB＝XA+x’B；[0020]YB＝YA+y’B。[0021]进一步地，根据A相机拍照点和可疑目标位置的UTM坐标计算在飞机悬停点时第二云台的俯仰角包括以下步骤：[0022]记可疑目标位置为B点，无人机悬停点为D点，无人机悬停点的星下点为C点，无人机悬停点对应的航向角为θC点的UTM坐标(XC，YC)；2，[0023]以C点为原点，正北为Y轴，正东为X轴，建立坐标系XCY，得到可疑目标位置在XCY下的坐标为X’Y’无人机悬停点D点在坐标系XCY下的坐标为(0，0，hD)，hD为B＝XB-XC，B＝YB-YC；高度；
[0024]
定义无人机悬停点到可疑目标位置之间的向量为(XB-XC，YB-YC，-hD)，定义无人
与
的夹角；
机悬停点到星下点的向量
[0025]
为(0，0，-hD)；则第二云台的俯仰角α为向量
计算第二云台的俯仰角α，计算公式为：
[0026]
其中，α的取值范围为0°～90°；
[0028]定义可见光相机的俯仰角定义为水平时为0°，向上旋转为正，向下旋转为负，得到第二云台的俯仰角Pitch＝α-90°，其中，Pitch的角度范围为-90°～0°。[0029]进一步地，根据A相机拍照点和可疑目标位置的UTM坐标计算在飞机悬停点时第二云台的方位角包括以下步骤：
[0030]
[0027]
定义星下点到可疑目标位置之间的向量则与正
北方向的夹角β的余弦为：
[0031][0032][0033]
其中，β的取值范围为0°-180°；
定义第二云台方位角为朝向机身正前方方向时为0°，顺时针旋转为正，逆时针旋
与正北方向的
转为负；以正北方向为0°，顺时针旋转为正建立方位角坐标系，得到向量夹角β′在方位角坐标系下的表达式：
[0034](XB-XC)≥0时，β’＝β[0035](XB-XC)<0时，β’＝360-β[0036]其中，β’的取值范围为0°-360°；[0037]计算第二云台的方位角，计算公式为：[0038]Yaw＝β’-θ2[0039]其中，Yaw的取值范围为0°-360°。[0040]本发明的有益效果是：
5
CN 111924101 A[0041]
说 明 书
3/5页
本发明通过提供的一种无人机双云台相机及其工作方法，通过在同一架无人机上
设置A相机和可见光相机同时工作，使用A相机进行可疑目标识别，当发现可疑目标后，使用可见光相机变焦进行高分RGB拍摄识别，避免了A相机对相近物体进行误识别的情况，提高了无人机巡检的精准度和可靠性。
附图说明
[0042]图1为本发明的无人机双云台相机的工作方法流程示意图。[0043]图2为本发明的可疑目标位置示意图。[0044]图3为本发明的无人机悬停点示意图。[0045]图4为本发明的方位角角度判断示意图。
[0046]图5为本发明第二具体实施例光伏巡检过程中热红外相机拍摄的可疑目标位置示意图。
[0047]图6为本发明第二具体实施例光伏巡检过程中可见光相机拍摄结果示意图。
[0048]图7为本发明第一具体实施例罂粟识别过程中多光谱相机拍摄的可疑目标位置示意图。
[0049]图8为本发明第一具体实施例罂粟识别过程中可见光相机拍摄的结果示意图。具体实施方式
[0050]现在结合附图1-4对本发明作进一步详细的说明。[0051]需要注意的是，发明中所引用的如“上”、“下”、“左”、“右”、“前”、“后”等的用语，亦仅为便于叙述的明了，而非用以限定本发明可实施的范围，其相对关系的改变或调整，在无实质变更技术内容下，当亦视为本发明可实施的范畴。[0052]如图1所示，在本发明的其中一个实施例中，一种无人机双云台相机，包括无人机机体，所述无人机的机体上设有第一云台和第二云台，所述第一云台上设有A相机，所述第二云台上设有可见光相机。[0053]在本实施例中，第一云台除了可以搭载多光谱相机，还可以搭载热红外相机或高光谱相机，诸如此类可以通过内置热红外或光谱算法高效识别可疑目标的相机。在实际使用过程中，根据检查目标的特征不同，可以采用对特定特征具有较好识别性的相机。可见光相机一般采用可见光云台变焦相机。通过在同一架无人机上设置多光谱相机和可见光相机，提高了无人机巡检的精准度和可靠性。进一步的，图1中无人机下方左侧相机为A相机，A相机可为多光谱相机，用于首先识别发现疑似目标，并将数据下发。[0054]第一具体实施例中，在使用多光谱相机来进行罂粟识别的时候，会发现在识别的时候，会有光谱相近的植物，或者物体干扰导致误识别，因此需要加上第二云台可见光相机一起解决此问题。多光谱相机识别发现如图7所示的疑似目标，可见光变焦相机确认目标如图8所示，运用于无人机多相机协同工作，即多光谱相机筛选可疑目标，可见光对筛选到的目标放大观察细节，最终确定目标。[0055]如图2-4所示，在本发明的其中一个实施例中，一种无人机双云台相机的工作方法，应用无人机双云台相机，包括以下步骤：[0056]步骤一：获取多光谱相机拍照点的经纬度并转换为UTM坐标，所述的UTM为
6
CN 111924101 A
说 明 书
4/5页
Universal Transverse Mercator Grid System，即通用横墨卡托格网系统；[0057]在本实施例中，当多光谱相机发现可疑目标时，将可疑目标的位置标记，并获取该位置的经纬度，然后转换为对应的UTM坐标；[0058]步骤二：根据多光谱相机拍照点的UTM坐标计算得出可疑目标位置的UTM坐标；[0059]在本实施例中，根据多光谱相机拍照点的UTM坐标计算得出可疑目标位置的UTM坐标具体包括以下步骤：
[0060]设多光谱相机拍照点的UTM坐标为(XA,YA)，以飞机飞行方向为y轴，垂直于飞机飞行的方向为x轴，多光谱相机拍照点为原点建立坐标系xAy；[0061]以正北为y’轴，正东为x’轴，建立坐标系x’Ay’,计算可疑目标位置在x’Ay’中的坐标，计算公式为：[0062]x’θθB＝(n-640)*d*cos1+(m-480)*d*sin1；[0063]y’θθB＝(m-480)*d*cos1-(n-640)*d*sin1；[0064]其中，θ正北为0°，范围为0°～360°，顺时针1为多光谱相机拍照点对应的航向角，为正方向，m，n分别为可疑目标位置在坐标系xAy的栅格行坐标和栅格列坐标，d为空间分辨率；
[0065]计算可疑目标位置的UTM坐标，计算公式为：[0066]XB＝XA+x’B；[0067]YB＝YA+y’B。[0068]步骤三：根据多光谱相机拍照点和可疑目标位置的UTM坐标计算在飞机悬停点时第二云台的俯仰角和方位角，然后对可疑目标位置进行高分RGB拍摄。[0069]在本实施例中，根据多光谱相机拍照点和可疑目标位置的UTM坐标计算在飞机悬停点时第二云台的俯仰角包括以下步骤：[0070]记可疑目标位置为B点，无人机悬停点为D点，无人机悬停点的星下点为C点，无人机悬停点对应的航向角为θC点的UTM坐标(XC，YC)；2，[0071]以C点为原点，正北为Y轴，正东为X轴，建立坐标系XCY，得到可疑目标位置在XCY下的坐标为X’Y’无人机悬停点D点在坐标系XCY下的坐标为(0，0，hD)，hD为B＝XB-XC，B＝YB-YC；高度；
[0072]
定义无人机悬停点到可疑目标位置之间的向量为(XB-XC，YB-YC，-hD)，定义无人
与
的夹角；
机悬停点到星下点的向量
[0073]
为(0，0，-hD)；则第二云台的俯仰角α为向量
计算第二云台的俯仰角α，计算公式为：
[0074]
其中，α的取值范围为0°～90°；
[0076]定义可见光相机的俯仰角定义为水平时为0°，向上旋转为正，向下旋转为负，得到第二云台的俯仰角Pitch＝α-90°，其中，Pitch的角度范围为-90°～0°。
[0077]根据多光谱相机拍照点和可疑目标位置的UTM坐标计算在飞机悬停点时第二云台的方位角包括以下步骤：
7
[0075]
CN 111924101 A[0078]
说 明 书
则
5/5页
定义星下点到可疑目标位置之间的向量与正
北方向的夹角β的余弦为：
[0079][0080][0081]
其中，β的取值范围为0°-180°；
定义第二云台方位角为朝向机身正前方方向时为0°，顺时针旋转为正，逆时针旋
与正北方向的
转为负；以正北方向为0°，顺时针旋转为正建立方位角坐标系，得到向量
夹角β′在方位角坐标系下的表达式：
[0082](XB-XC)≥0时，β’＝β[0083](XB-XC)<0时，β’＝360-β[0084]其中，β’的取值范围为0°-360°；[0085]计算第二云台的方位角，计算公式为：[0086]Yaw＝β’-θ2[0087]其中，Yaw的取值范围为0°-360°。[0088]如图5-6所示，在本发明的第二具体实施例中，上述的无人机双云台相机及其工作方法还可以应用于光伏巡检领域，在本实施例中选用DJI M210 RTK型号的可挂载双云台的无人机，第一云台搭载DJI XT2型号的热红外相机，第二云台搭载Z30型号的可见光变焦相机，当XT2热红外相机识别到疑似目标物体后，根据上述工作方法，可以将Z30可见光变焦相机云台旋转至该区域，对该区域变焦放大，再通过比对光伏面板的热红外图像和RGB可见光图像，具体分析光伏面板的故障原因。
[0089]以上仅是本发明的优选实施方式，本发明的保护范围并不仅局限于上述实施例，凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理前提下的若干改进和润饰，应视为本发明的保护范围。
8
CN 111924101 A
说 明 书 附 图
1/6页
图1
图2
9
CN 111924101 A
说 明 书 附 图
2/6页
图3
10
CN 111924101 A
说 明 书 附 图
3/6页
图4
11
CN 111924101 A
说 明 书 附 图
4/6页
图5
12
CN 111924101 A
说 明 书 附 图
5/6页
图6
图7
13
CN 111924101 A
说 明 书 附 图
6/6页
图8
14
因篇幅问题不能全部显示，请点此查看更多更全内容