无人机定位系统、无人机以及无人机定位方法技术方案

本发明专利技术公开了一种无人机定位系统、无人机以及无人机定位方法，其包括：具有图像获取单元的视觉处理模块，其用于获取视觉地图上的视觉图案的相关信息，并根据所述视觉图案的相关信息获取无人机的位置，且相邻视觉图案的顶点按照预定规则连接，两个顶点的连接处形成一角点；所述视觉处理模块确定所述无人机的位置坐标和姿态信息。本发明专利技术可在gps定位不可靠的环境中或无惯性导航系统的条件下实现无人机的高精度定位与实时导航，且只需要通过二维码、条码等构建通过机器视觉能够识别的视觉地图即可达到实时定位和控制无人机飞行姿态的目的，简单实用，同时，还可根据自主规划飞行路线，提高工作效率。

【技术实现步骤摘要】
无人机定位系统、无人机以及无人机定位方法
本专利技术涉及定位导航领域，具体涉及一种无人机定位系统、无人机以及无人机定位方法。
技术介绍
目前，诸如无人机等运动载体的定位与导航只能依靠GPS和惯性导航系统，但在惯性导航系统中，由于其传感器容易受到外界环境干扰，因此导致定位精度低；在GPS定位系统中，由于地形、人造建筑物等因素的限制，局部地区GPS信号较弱或者无GPS信号，因此这些区域也无法依靠GPS实现自主导航。
技术实现思路
针对上述缺陷，本专利技术提供了一种无人机定位系统、无人机以及无人机定位方法，其通过二维码等视觉图案构建可识别的视觉地图，由此即使在gps定位不可靠的环境或无惯性导航系统的条件下实现无人机的高精度定位与实时导航。本专利技术就上述技术问题而提出的技术方案如下：一方面，提供了一种无人机定位系统，其包括：具有图像获取单元的视觉处理模块，其用于获取视觉地图上的视觉图案的相关信息，并根据所述视觉图案的相关信息获取无人机的位置信息，且相邻视觉图案的顶点按照预定规则连接，两个顶点的连接处形成一角点；所述视觉处理模块根据下列公式(1)-(7)确定所述无人机的位置坐标；H＝[h1h2h3]＝λK[r1r2t](5)；其中，s为尺度因子，Z＝0，H为单应矩阵，R为旋转矩阵，T为平移矩阵，u，v为形成的角点的像素坐标，XYZ为三维世界坐标；xc＝0，yc＝0，zc＝0，三者均为图像获取单元在图像获取单元坐标系中的坐标，Xc，Yc，Zc为图像获取单元在三维世界坐标系中的坐标。优选的，所述视觉处理模块还根据下列公式(8)-(11)确定所述无人机的姿态信息；θz＝atan2(r21，r11)(8)；其中，θx，θy，θz为图像获取单元的三轴旋转角，R为旋转矩阵。优选的，所述定位环境为室内环境或全球定位系统信号不可靠的环境。优选的，所述视觉地图具有至少一个视觉图案，每一所述视觉图案均为相同的多边形，且每一所述视觉图案上均附有该视觉图案的相关信息。优选的，所述无人机定位系统还包括：路径规划模块，其根据起点和终点、起点与终点之间的路径特点以及获取的视觉地图信息自主构建连接起点和位置的路径；以及运动控制模块，其用于利用目标期望航点的期望位置、期望航向的期望速度矢量、无人机的期望高度和无人机整体的飞行姿态信息生成制导指令，且根据所述制导指令调整所述无人机的位置和/或控制所述无人机的飞行姿态。优选的，所述自主构建连接起点和终点的路径的方法包括模拟退火算法、人工势场法、模糊逻辑算法、禁忌搜索算法、可视图空间、栅格法、蚁群算法、神经网络算法、遗传算法中的一种或几种。另一方面，还提供一种无人机组件，其包括：机体以及上述无人机定位系统。优选的，所述无人机组件还包括：样品检测模块，其包括至少一个监测传感器，其用于在无人机飞行过程中采集环境中的样品，并对其进行分析，以获取样品监测信息，并将所述监测信息发送至用户处的终端进行显示；以及物体识别模块，其用于获取附着于待监视物体表面的物体信息，且将所述物体信息发送至用户处的终端进行显示。另一方面，还提供一种无人机的定位方法，其包括如下步骤：S1、在环境中设置视觉地图；S2、通过视觉处理模块的图像获取单元抓取所述视觉地图上的视觉图案，获取该视觉图案的相关信息，且根据视觉图案的相关信息确定两视觉图案连接的顶点所形成的角点的位置坐标，根据下列公式(1)-(7)确定所述无人机的位置坐标；H＝[h1h2h3]＝λK[r1r2t](5)；其中，s为尺度因子，Z＝0，H为单应矩阵，R为旋转矩阵，T为平移矩阵，u，v为形成的角点的像素坐标，XYZ为三维世界坐标；xc＝0，yc＝0，zc＝0，三者均为图像获取单元在图像获取单元坐标系中的坐标，Xc，Yc，Zc为图像获取单元在三维世界坐标系中的坐标；以及根据下列公式(8)-(11)确定所述无人机的姿态信息；θz＝atan2(r21，r11)(8)；其中，θx，θy，θz为图像获取单元的三轴旋转角，R为旋转矩阵。优选的，还包括：S3、路径规划模块根据起点和终点、起点与终点之间的路径的特点及获取的视觉地图信息自主构建连接起点和终点的路径；以及S4、运动控制模块利用目标期望航点的期望位置、期望航向的期望速度矢量、无人机的期望高度和无人机整体的飞行姿态信息生成制导指令，且根据所述制导指令调整所述无人机的位置和/或控制所述无人机的飞行姿态。本专利技术可在gps定位不可靠的环境中或无惯性导航系统的条件下实现无人机的高精度定位与实时导航，且只需要通过二维码、条码等构建通过机器视觉能够识别的视觉地图即可达到实时定位和控制无人机飞行姿态的目的，简单实用，同时，还可根据自主规划飞行路线，提高工作效率。附图说明图1为实施例一中无人机定位系统的结构示意图；图2a为实施例一中无人机、视觉地图的结构示意图；图2b为实施例一中角点的示意图；图3为实施例二中无人机的结构示意图；图4为实施例二中无人机与待监视物体的结构示意图。具体实施方式为了对本专利技术的技术特征、目的和效果有更加清楚的理解，现对照附图详细说明本专利技术的具体实施方式。实施例一：如图1-2a所示，本实施例中无人机定位系统包括：视觉处理模块1，其用于获取视觉地图2上的视觉图案21信息，并根据所述视觉图案21的相关信息获取所述无人机100的位置和姿态信息；所述视觉地图设置于定位环境中；其中，所述定位环境为室内环境或全球定位系统(GPS)信号不可靠的环境；优选的，所述视觉地图2具有至少一个视觉图案21，且每一所述视觉图案21颜色相同，本实施例中，每一所述视觉图案21均为相同的多边形(包括正多边形，如正方形、菱形、正三角形等)；同时，如图2b所示，每一所述视觉图案上均通过二维码、条码、AprilTag、QR码等方式附有该视觉图案的相关信息(如该视觉图案对应的编号、形状、面积大小、顶点坐标等)，且不同视觉图案21的顶点按照预定规则连接，例如，一视觉图案21的某一顶点仅对应连接相邻的、另一视觉图案21的某一顶点，两个顶点的连接处形成一角点22；具体的，所述视觉处理模块1包括图像获取单元11、位置确定单元12和姿态确定单元13；其中，所述图像获取单元11(如相机等)用于抓取所述视觉图案21，且通过识别二维码、条码、AprilTag、QR码等方式获取该视觉图案的相关信息，所述位置确定单元12连接所述图像获取单元11，用于根据视觉图案21的相关信息确定两视觉图案连接的顶点所形成的角点22的位置坐标，如根据顶点连接的两视觉图案的编号获取所形成的角点22的坐标信息，从而确定至少一个角点22(优选4个以上角点22)的位置坐标；以及根据下列公式(1)-(7)确定所述无人机的位置坐标：H＝[h1h2h3]＝λK[r1r2t](5)；其中，s为尺度因子，Z＝0，H为单应矩阵，R为旋转矩阵，T为平移矩阵，u，v为形成的角点的像素坐标，XYZ为三维世界坐标(即无人机的实际飞行坐标)；xc＝0，yc＝0，zc＝0，三者均为图像获取单元在图像获取单元坐标系中的坐标，Xc，Yc，Zc为图像获取单元在三维世界坐标系中的坐标；由此，在获取图像获取单元在三维世界坐标系中的坐标后即可确定无人机整体在三维世界坐标系中的实际位置；所述姿态确定单元13连接所述图像获取单元11，用于根据下列公式本文档来自技高网...

【技术保护点】
1.一种无人机定位系统，其包括：具有图像获取单元的视觉处理模块，其用于获取视觉地图上的视觉图案的相关信息，并根据所述视觉图案的相关信息获取无人机的位置信息，且相邻视觉图案的顶点按照预定规则连接，两个顶点的连接处形成一角点；其特征在于，所述视觉处理模块根据下列公式(1)‑(7)确定所述无人机的位置坐标；

【技术特征摘要】
1.一种无人机定位系统，其包括：具有图像获取单元的视觉处理模块，其用于获取视觉地图上的视觉图案的相关信息，并根据所述视觉图案的相关信息获取无人机的位置信息，且相邻视觉图案的顶点按照预定规则连接，两个顶点的连接处形成一角点；其特征在于，所述视觉处理模块根据下列公式(1)-(7)确定所述无人机的位置坐标；H＝[h1h2h3]＝λK[r1r2t](5)；其中，s为尺度因子，Z＝0，H为单应矩阵，R为旋转矩阵，T为平移矩阵，u，v为形成的角点的像素坐标，XYZ为三维世界坐标；xc＝0，yc＝0，zc＝0，三者均为图像获取单元在图像获取单元坐标系中的坐标，Xc，Yc，Zc为图像获取单元在三维世界坐标系中的坐标。2.如权利要求1所述的无人机定位系统，其特征在于，所述视觉处理模块还根据下列公式(8)-(11)确定所述无人机的姿态信息；θz＝atan2(r21，r11)(8)；其中，θx，θy，θz为图像获取单元的三轴旋转角，R为旋转矩阵。3.如权利要求1所述的无人机定位系统，其特征在于，所述定位环境为室内环境或全球定位系统信号不可靠的环境。4.如权利要求1所述的无人机定位系统，其特征在于，所述视觉地图具有至少一个视觉图案，每一所述视觉图案均为相同的多边形，且每一所述视觉图案上均附有该视觉图案的相关信息。5.如权利要求1所述的无人机定位系统，其特征在于，所述无人机定位系统还包括：路径规划模块，其根据起点和终点、起点与终点之间的路径特点以及获取的视觉地图信息自主构建连接起点和位置的路径；以及运动控制模块，其用于利用目标期望航点的期望位置、期望航向的期望速度矢量、无人机的期望高度和无人机整体的飞行姿态信息生成制导指令，且根据所述制导指令调整所述无人机的位置和/或控制所述无人机的飞行姿态。6.如权利要求5所述的无人机定位系统，其特征在于，所述自主构建连接起点和终点的路径的方法包括模拟退火算法、人工势场法、模糊逻辑算法、禁忌搜...

【专利技术属性】
技术研发人员：黄立，李波，刘寿宝，周忠芬，顾兴，刘华斌，王效杰，
申请(专利权)人：普宙飞行器科技深圳有限公司，
类型：发明
国别省市：广东,44