[发明专利]基于户型图标定的室内无人机导航方法

说明书

本发明公开了基于户型图标定的室内无人机导航系统。首先确定好无人机机头的初始位置以及角度后，在户型图中将飞行轨迹连续标定像素点，通过标定像素点计算出无人机的飞行轨迹向量，再通过比例尺计算出无人机飞行过程中的偏移角跟位移，从而应用于控制无人机精准监控室内施工、定检巡航等领域实时导航。本发明提供的基于户型图标定的室内无人机导航计算量低，准确度高，实时性高，功耗低，成本低等优点。

技术领域

本发明公开了基于户型图标定的室内无人机导航系统。

背景技术

在现有的无人机自动导航技术中，如果在室内GPS信号不可用的情况下，基于多目视觉系统计算量大，成本高，实时性难以保障，需要GPU或者高性能的CPU参与计算；而基于雷达的导航在硬装过程中由于粉尘等因素影响精度难以达到正负0.1m的要求，同时粉尘等因素造成的计算量增长导致RTOS实时系统也无法满足的场景。

发明内容

本发明公开了基于户型图标定的室内无人机导航系统。其具有计算量低，准确度高，实时性高，功耗低，成本低等优点。

基于户型图标定的室内无人机导航方法，包括如下步骤：

第1步，在户型图中，对无人机的拟飞行轨迹上的位置点依次进行标定，设各个位置点在户型图中的坐标位置分别为(xi，yi)，i＝0，1，2，……，n；

第2步，计算出在相邻两个位置点之间的飞行轨迹向量；

第3步，根据户型图的比例尺计算出在各个位置点之间的飞行实际距离。

在一个实施方式中，设无人机的初始向量为单位向量(1，0)。

在一个实施方式中，设无人机机头的初始位置与门的方向成90°夹角。

在一个实施方式中，所述的第2步中，通过两个相邻的位置坐标的向量叉乘计算得到飞行旋转方向。

在一个实施方式中，旋转方向为

在一个实施方式中，第3步中，通过distance＝|(x_n-x_n-1，y_n-y_n-1)|·ratio计算出相邻点之间的飞行距离。

在一个实施方式中，无人机通过GSP导航至第1步中需要采用户型图导航的初始位置。

在一个实施方式中，无人机通过通过上下左右前后6个红外传感器进行避障。

在一个实施方式中，遇到红外传感器上报高电平中断原有的飞行指令，向相反方向做避障导航，重新标定导航点后，继续进行导航。

在一个实施方式中，无人机通过无线传输模块与服务器连接，将数据上传至服务器中进行数据分析，监控。

有益效果

在室内对精度要求高，实时性要求高，同时由于硬装过程中粉尘等干扰因素多的场景下，通过该发明能有效解决上述问题，同时具备低功耗，低成本的硬件部署，RTOS系统即可用于生产。

附图说明

图1是本发明的导航方法的流程图；

图2是简化的坐标系空间；

图3是复杂坐标系空间；

图4是在户型图中设定的轨迹线；

图5是通过点乘计算向量夹角缺失信息的示意图；

图6是硬件模块示意图。

具体实施方式

实施例1