基于小型四旋翼无人机的构图装置及方法

文档序号:6305008阅读:240来源:国知局
基于小型四旋翼无人机的构图装置及方法
【专利摘要】本发明一种基于小型四旋翼无人机的构图装置及方法,属于移动机器人定位与导航【技术领域】,本发明使用小型旋翼无人机可以快速地进入到移动机器人无法进入的复杂环境中,利用搭载的激光雷达根据SLAM方法实时构建出二维地图,再结合IMU等装置可以实现无人机的自主定位和导航,实现对真实复杂区域的高效探索;小型四旋翼无人机能够方便地调整高度获取不同高度水平面上的二维地图;小型悬翼无人机移动速度快,更加灵活,它的运动和建图不会受到地面上障碍物的干扰,突破了探测机器人的范围限制,具有很强的实用价值,能够实现准确快速的地图构建;与机器人环境构图相比,旋翼无人机能够更快、更灵活地实施环境侦察,而且可以获得立体空间图像。
【专利说明】基于小型四旋翼无人机的构图装置及方法
【技术领域】
[0001]本发明属于移动机器人定位与导航【技术领域】,具体涉及一种基于小型四旋翼无人机的构图装置及方法。
【背景技术】
[0002]近年来,移动机器人得到的迅速的发展,移动机器人的定位和导航也越来越受到重视。实现自主定位和导航是机器人完成各种任务的重要前提,而实现定位和导航的关键在于建立起完整的地图信息,因此,二维构图对于移动机器人技术的发展具有重要的意义。随着技术的不断发展,对地图创建的要求也越来越高,尤其对于灾难现场等一些障碍比较多、结构比较复杂、对建图实时性要求高的复杂场合,传统的地图创建方法很难胜任。基于机器视觉的地图创建方法只能创建高度信息地图,地图信息比较单一,而且对图像的处理对电脑要求较高,建图速度也不理想。针对这些情况,出现了移动机器人一边运动一边创建地图(SLAM, Simultaneous localization and mapping)的方法,这种方法在一定程度上克服了一些上述的障碍,但是依然有很多的弊端:机器人的运动都依赖履带或者轮子,在狭小的空间中实现转向会比较困难,而且机器人只能在地面上运动,容易受到地面障碍物的干扰;在多楼层环境中,机器人只能在有限的楼层范围内进行探索,很难进入到高楼层区域,移动范围受到了极大的限制,无法实现复杂环境的侦察和构图;地面移动机器人只能在地面上运动,其建立的二维地图也就局限于接近地面的高度,得到的地图信息过于单一,应用价值和使用范围爱到了很大的限制。因此,目前利用上述两种方式进行室内环境信息的感知和探索都难以达到理想的效果。

【发明内容】

[0003]针对现有技术的缺点,本发明提出一种基于小型四旋翼无人机的构图装置及方法,以达到在复杂环境中快速准确地构建出二维地图的目的。
[0004]一种基于小型四旋翼无人机的构图装置,包括四旋翼无人机、激光雷达、无线路由器、反光镜,还包括PC机、远程控制开关、机载计算机、控制器和电源,其中,所述的激光雷达设置于四旋翼无人机上端中心位置,反光镜设置于激光雷达发射端初始位置相对处,并与四旋翼无人机平面之间的夹角为45°,所述的远程控制开关、机载计算机、控制器和电源构成机载控制部分,设置于四旋翼无人机的中心位置;
[0005]所述的激光雷达的输出端连接机载计算机的输入端,机载计算机的输出端连接控制器的输入端,控制器的四路输出端分别连接四旋翼无人机四个螺旋桨的电机输入端,在控制器与电源之间设置有远程控制开关;所述的机载计算机通过无线网络连接无线路由器,并且无线路由器通过无线网络连接PC机。
[0006]所述的PC机内部包括环境构图模块、构图矫正模块和路径规划模块,其中,
[0007]环境构图模块:用于采用同步定位与地图构建方法(SLAM)根据激光雷达采集到的激光数据进行扫描区域的构图,所述的激光数据包括扫描角度和该角度对应反射点的距离;
[0008]构图矫正模块:用于根据控制器内部的惯性测量单元测量的无人机倾斜角度和每个扫描角度对应反射点的距离,计算获得每个反射点水平方向上的距离,根据每个反射点水平方向上的距离重新进行构图,获得矫正后的环境构图;
[0009]路径规划模块:用于基于代价地图(costmap)的Di jkstra最优路径算法根据获得的矫正后的环境构图获得无人机飞行路径,并将飞行路径通过机载计算机发送至控制器中。
[0010]所述的远程控制开关包括一个电阻、一个电源接口、一个机载计算机接口、一个天线接口、一个稳压管、一个MOSFET管,其中,稳压管的输入端同时连接电源接口的输出端和机载计算机接口的输入端,稳压管的输出端连接天线接口的输入端,稳压管的输入端接地,天线接口的另一个端口同时连接MOSFET管的栅极和电阻的一端,电阻的另一端接地,MOSFET管的源极接地,MOSFET管的漏极连接机载计算机接口的输出端。
[0011]还设置有一个用于控制远程控制开关的遥控器和一个天线,所述的天线通过天线接口连接远程控制开关,遥控器发送紧急信号至天线,使其强制切断控制器的电源。
[0012]采用基于小型四旋翼无人机的构图装置进行的构图方法,包括以下步骤:
[0013]步骤1、在目标构图区域内,以无人机起飞位置作为原点建立坐标系,并根据实际需求设置无人机的目标飞行高度和飞行速度;
[0014]步骤2、启动无人机上升飞行,采用激光雷达发射激光并通过反射镜反射激光,根据反射的时间,计算无人机实时飞行高度,当无人机达到目标飞行高度时停止上升;
[0015]步骤3、在目标高度,采用激光雷达进行旋转扫描,获得不同激光雷达数据,所述的激光雷达数据包括采样旋转角度和该角度对应反射点的距离,并将采激光雷达数据发送至机载计算机中;
[0016]步骤4、机载计算机将激光雷达数据通过无线路由器发送至PC机中;
[0017]步骤5、PC机内部的环境构图模块采用同步定位与地图构建方法根据激光雷达采集到的采样旋转角度对应反射点所在坐标系中的位置进行扫描区域的构图;
[0018]步骤6、采用控制器内部的惯性测量单元测量的无人机倾斜角度,并根据每个扫描角度对应反射点的距离,计算获得每个反射点水平方向上的距离,根据每个反射点水平方向上的距离重新进行构图,获得最终的环境构图,完成构图的矫正;
[0019]步骤7、返回执行步骤3进行多次的扫描构图,实时获得环境构图并执行步骤8 ;
[0020]步骤8、根据无人机当前在坐标系中的位置和飞行速度,采用基于代价地图的Dijkstra最优路径算法根据获得的实时环境地图获得无人机实时飞行路径,并将实时飞行路径通过机载计算机发送至控制器中,所述的飞行路径终点为根据需求设定的重点扫描区域;
[0021]步骤9、控制器根据获得的飞行路径发送控制信号至无人机四个螺旋桨的电机中,实现无人机自动飞行;
[0022]步骤10、无人机按照飞行路径至终点后,切换为手动控制,在根据实际需求设定的高度范围内进行不同高度的实时扫描,进而完成重点区域的立体扫描构图。
[0023]步骤8所述的采用基于代价地图的Dijkstra最优路径算法根据获得的实时环境构图获得无人机实时飞行路径,具体为:将构建的二维地图的长和宽根据需求进行平均分害!],进而实现对二维地图的网格划分,根据每个网格与障碍物的距离设置每个网格的代价值,网格与障碍物距离越近代价值越大,代价值的取值范围为O~255,再采用Dijkstra算法获得代价地图上一条代价值最小的路径,即为无人机规划出来的路径。
[0024]本发明优点:
[0025]本发明一种基于小型四旋翼无人机的构图装置及方法,使用小型旋翼无人机可以快速地进入到移动机器人无法进入的复杂环境中,利用搭载的激光雷达根据SLAM方法实时构建出二维地图,再结合MU等装置可以实现无人机的自主定位和导航,实现对真实复杂区域的高效探索;同时,小型四旋翼无人机能够方便地调整高度,获取不同高度水平面上的二维地图,从而能够获取更多的信息;小型悬翼无人机移动速度快,更加灵活,它的运动和建图不会受到地面上障碍物的干扰,不仅能原地360度调整方向,而且能够到达高楼层、火灾或者地震现场等复杂危险的区域,突破了探测机器人的范围限制,具有很强的实用价值,能够实现准确快速的地图构建;与机器人环境构图相比,旋翼无人机能够更快、更灵活地实施环境侦察,而且可以获得立体空间图像。
【专利附图】

【附图说明】
[0026]图1为本发明 一种实施例的基于小型四旋翼无人机的构图装置结构示意图;
[0027]图2为本发明一种实施例的机载控制部分结构示意图;
[0028]图3为本发明一种实施例的激光雷达电路原理图;
[0029]图4为本发明一种实施例的基于小型四旋翼无人机的构图方法流程图;
[0030]图5为本发明一种实施例的信号走向示意图;
[0031]图6为本发明一种实施例的激光雷达的角度不意图;
[0032]图7为本发明一种实施例的激光测高及倾斜角度原理示意图;
[0033]图8为本发明一种实施例的建图误差分析图;
[0034]图9为本发明一种实施例的构建的室内二维地图。
【具体实施方式】
[0035]下面结合附图对本发明一种实施例做进一步说明。
[0036]如图1所示,本发明实施例中基于小型四旋翼无人机的构图装置,包括四旋翼无人机1、激光雷达4、无线路由器2、反光镜6、PC机3,如图2所示,远程控制开关5-1、机载计算机5-2、控制器5-3和电源5-4,其中,所述的激光雷达4设置于四旋翼无人机I上端中心位置,反光镜6设置于激光雷达4发射端初始位置相对处,并与四旋翼无人机I平面之间的夹角为45°,所述的远程控制开关5-1、机载计算机5-2、控制器5-3和电源5_4构成机载控制部分5,设置于四旋翼无人机I的中心位置。
[0037]本发明实施例中,激光雷达采用UTM-30LX型号,它采集其扫描平面上270度范围内的距离信息,扫描频率40Hz,最远探测距离30米;精度0.1~IOm: ±30mm, 10~30m:±50mm ;采用USB2.0与机载电脑进行通信;飞行控制器采用APM2.5.2型号;记载计算机采用树莓派2 ;如图2所示,激光雷达4的输出端连接机载计算机5-2的一个USB端口,机载计算机5-2的TXD、RXD和USB端口连接控制器5-3的TXD、RXD和USB端口,控制器5-3的四路输出端outl、out2、out3、out4分别连接四旋翼无人机I四个螺旋桨的电机输入端,在控制器输出端和螺旋桨之间还装有电调装置,在控制器5-3与电源5-4之间设置有远程控制开关5-1 (KILLSffITCH);所述的机载计算机5_2通过无线网络WIFI连接无线路由器2,并且无线路由器2通过无线网络连接PC机3 ;本发明实施例中,机载计算机5-2的一个usb 口插有无线网卡,通过无线网卡实现通讯。
[0038]本发明实施例中,利用无线路由器的11 (或13)信道进行数据传输。有效作用距离最大可达到300米,若采取信号增强措施则可以达到500米以上。路由器放置于待探索区域和PC机之间的中点位置处,这样能使数据的传输距离最远,最远能够达到路由器有效距离的2倍。为了提高路由器的传输效率,可以将路由器的传输功率设置为“高”,保证数据的高速传输。
[0039]本发明实施例中,由于机载计算机配置的限制,需要将实时获取的激光数据返回到PC机上进行处理,这样做一方面减轻了机载计算机的负荷,延长无人机的电池续航时间;另一方面,在PC机上建图提高了精度,而且PC机上能够最早获取地图信息。在建图模块中核心是SLAM,为了提高建图的精度,根据IMU测量的无人机的姿态信息对获取的激光数据进行修正,进而修正建图的误差。为了保证安全,在无人机上安装KILLSWITCH,在紧急情况下对无人机强制关闭电源,保证飞行的安全。
[0040]本发明实施例中,PC机内部包括环境构图模块、构图矫正模块和路径规划模块,其中,环境构图模块用于采用同步定位与地图构建方法(SLAM)根据激光雷达采集到的激光数据进行扫描区域的构图,所述的激光数据包括扫描角度和该角度对应反射点的距离;构图矫正模块用于根据控制器内部的IMU(惯性测量单元,Inertia measurement unit)测量的无人机倾斜角度和每个扫描角度对应反射点的距离,计算获得每个反射点水平方向上的距离,根据每个反射点水平方向上的距离重新进行构图,获得矫正后的环境构图;路径规划模块用于基于代价地图的Dijkstra最优路径算法根据获得的矫正后的环境构图获得无人机飞行路径,并将飞行路径通过机载计算机发送至控制器中,无人机飞行过程中需要进行自主避障,根据得到的二维地图,对无人机进行路径规划,实现无人机自主避障。
[0041]本发明实施例中,远程控制开关包括一个电阻(47kQ色环直插电阻)、一个电源接口 J2、一个机载计算机接口 J3、一个天线接口 Jl、一个7805稳压管Ql、一个MOSFET管(irf4410z cmos 晶体管)Q2, IMU 是惯性测量单兀 Inertial Measurement Unit,型号是MPU-6000,可以实时测量出无人机的三轴姿态角以及加速度的信息。
[0042]如图3所示,稳压管Ql的输入端INPUTO同时连接电源接口的输出端1、2和机载计算机接口的输入端1、2,稳压管的输出端VCC连接天线接口的输入端6,稳压管Ql的输入端接地,天线接口的端口 4同时连接MOSFET管Q2的栅极和电阻Rl的一端,电阻Rl的另一端接地,MOSFET管Q2的源极接地,MOSFET管Q2的漏极连接机载计算机接口的输出端0UTPUT1,还设置有一个用于控制远程控制开关的遥控器和一个天线(无线接收模块(2272)解码),所述的天线通过天线接口连接远程控制开关,遥控器发送紧急信号至天线,使其强制切断控制器的电源。
[0043]采用基于小型四旋翼无人机的构图装置进行的构图方法,方法流程图如图4所示,信号走向示意图如图5所示,其中,空心箭头表示数据流动及方向,实心箭头表示装置连接关系;
[0044]方法具体包括以下步骤:[0045]步骤1、在目标构图区域内,以无人机起飞位置作为原点(0,0)建立坐标系,并根据实际需求设置无人机的目标飞行高度和飞行速度;
[0046]本发明实施例中,起飞位置指无人机在建筑物入口处所获取的位置,进行二维建图时需要有坐标原点,取无人机的起飞位置为坐标系的原点(0,0),同时取飞机的正前方为y轴正方向,与y轴垂直且与y轴成右手坐标系的方向为X轴正方向。另外还要根据周围环境的实际情况设置无人机的飞行高度和飞行速度,保证无人机的稳定飞行和准确建图。
[0047]步骤2、操作人员通过遥控器控制无人机起飞,切换到自动模式,采用激光雷达发射激光并通过反射镜反射激光,根据反射的时间,计算无人机实时飞行高度,当无人机达到目标飞行高度时停止上升;
[0048]本发明实施例中,与移动机器人相比,无人机的运动控制更加复杂,最明显的体现就在高度控制上;移动机器人没有高度的信息,但这也限制了它的灵活性和室内环境构图的适用性。一般在无人机上都采用GPS和气压计来测量无人机的飞行高度,但是GPS测高的精度比较低,而气压计的输出值比较容易受到气流的影响。所以这两种测高方式都无法满足室内高度控制精度的要求。针对这种情况,本发明中采用在激光雷达侧面加一面反光镜的方式测量飞行器的高度;由于平面镜面积较小,因此只需要提取一个比较小的夹角内的激光就能用来测高,同时不会影响建图;通过几何计算,可以得到无人机的真实高度。
[0049]在真实复杂的环境中,地面上往往存在障碍物,给高度的测量造成了一定的困难;当水平地面上突然出现 障碍物时,无人机的高度会出现突然的跳变,在这个跳变点上通过与跳变之前的高度值对比即可求得障碍物的高度,进而对无人机的飞行高度进行调整。
[0050]本发明实施例中,操作人员通过无线通信遥控飞机,即利用遥控器发出无线控制信号,安装在四旋翼无人机上的机载计算机机接受信号,然后向无人机控制器输出PWM信号控制无人机的飞行。
[0051]本发明实施例中,根据实际飞行高度和目标飞行高度,可以采取PID控制算法、模糊控制算法等使无人机达到期望的高度;本发明采用PID控制,PID控制带限幅,是一种非线性控制方式,P参数根据目标高度与测量高度之差乘以系数得到,输入为目标高度与测量并经过处理后的高度之差,输出为无人机油门控制量,反馈为测量并经过处理后的高度。
[0052]因为激光雷达得到的数据是数字信号,PID算法中目标高度为标准值r (η),实际高度为反馈值c (η),偏差e (η)为:
[0053]e (η) = r (n) ~c (η) (I)
[0054]偏差依次通过比例,积分、微分环节,得到输入量为:
[0055]
【权利要求】
1.一种基于小型四旋翼无人机的构图装置,包括四旋翼无人机、激光雷达、无线路由器、反光镜,其特征在于,还包括PC机、远程控制开关、机载计算机、控制器和电源,其中,所述的激光雷达设置于四旋翼无人机上端中心位置,反光镜设置于激光雷达发射端初始位置相对处,并与四旋翼无人机平面之间的夹角为45°,所述的远程控制开关、机载计算机、控制器和电源构成机载控制部分,设置于四旋翼无人机的中心位置; 所述的激光雷达的输出端连接机载计算机的输入端,机载计算机的输出端连接控制器的输入端,控制器的四路输出端分别连接四旋翼无人机四个螺旋桨的电机输入端,在控制器与电源之间设置有远程控制开关;所述的机载计算机通过无线网络连接无线路由器,并且无线路由器通过无线网络连接PC机。
2.根据权利要求1所述的基于小型四旋翼无人机的构图装置,其特征在于,所述的PC机内部包括环境构图模块、构图矫正模块和路径规划模块,其中, 环境构图模块:用于采用同步定位与地图构建方法根据激光雷达采集到的激光数据进行扫描区域的构图,所述的激光数据包括扫描角度和该角度对应反射点的距离; 构图矫正模块:用于根据控制器内部的惯性测量单元测量的无人机倾斜角度和每个扫描角度对应反射点的距离,计算获得每个反射点水平方向上的距离,根据每个反射点水平方向上的距离重新进行构图,获得矫正后的环境构图; 路径规划模块;用于基于代价地图的Dijkstra最优路径算法根据获得的矫正后的环境构图获得无人机飞行路径,并将飞行路径通过机载计算机发送至控制器中。
3.根据权利要求1所述的基于小型四旋翼无人机的构图装置,其特征在于,所述的远程控制开关包括一个电阻 、一个电源接口、一个机载计算机接口、一个天线接口、一个稳压管、一个MOSFET管,其中,稳压管的输入端同时连接电源接口的输出端和机载计算机接口的输入端,稳压管的输出端连接天线接口的输入端,稳压管的输入端接地,天线接口的另一个端口同时连接MOSFET管的栅极和电阻的一端,电阻的另一端接地,MOSFET管的源极接地,MOSFET管的漏极连接机载计算机接口的输出端。
4.根据权利要求1所述的基于小型四旋翼无人机的构图装置,其特征在于,还设置有一个用于控制远程控制开关的遥控器和一个天线,所述的天线通过天线接口连接远程控制开关,遥控器发送紧急信号至天线,使其强制切断控制器的电源。
5.采用权利要求1所述的基于小型四旋翼无人机的构图装置进行的构图方法,其特征在 于:包括以下步骤: 步骤1、在目标构图区域内,以无人机起飞位置作为原点建立坐标系,并根据实际需求设置无人机的目标飞行高度和飞行速度; 步骤2、启动无人机上升飞行,采用激光雷达发射激光并通过反射镜反射激光,根据反射的时间,计算无人机实时飞行高度,当无人机达到目标飞行高度时停止上升; 步骤3、在目标高度,采用激光雷达进行旋转扫描,获得不同激光雷达数据,所述的激光雷达数据包括采样旋转角度和该角度对应反射点的距离,并将采激光雷达数据发送至机载计算机中; 步骤4、机载计算机将激光雷达数据通过无线路由器发送至PC机中; 步骤5、PC机内部的环境构图模块采用同步定位与地图构建方法根据激光雷达采集到的采样旋转角度对应反射点所在坐标系中的位置进行扫描区域的构图; 步骤6、采用控制器内部的惯性测量单元测量的无人机倾斜角度,并根据每个扫描角度对应反射点的距离,计算获得每个反射点水平方向止的距离,根据每个反射点水平方向上的距离重新进行构图,获得最终的环境构图,完成构图的矫正; 步骤7、返回执行步骤3进行多次的扫描构图,实时获得环境构图并执行步骤8 ; 步骤8、根据无人机当前在坐标系中的位置和飞行速度,采用基于代价地图的Dijkstra最优路径算法根据获得的实时环境地图获得无人机实时飞行路径,并将实时飞行路径通过机载计算机发送至控制器中,所述的飞行路径终点为根据需求设定的重点扫描区域; 步骤9、控制器根据获得的飞行路径发送控制信号至无人机四个螺旋桨的电机中,实现无人机自动飞行; 步骤10、无人机按照飞行路径至终点后,切换为手动控制,在根据实际需求设定的高度范围内进行不同高度的实时扫描,进而完成重点区域的立体扫描构图。
6.根据权利要求5所述的构图方法,其特征在于,步骤8所述的采用基于代价地图的Dijkstra最优路径算法根据获得的实时环境构图获得无人机实时飞行路径,具体为:将构建的二维地图的长和宽根据需求进行平均分割,进而实现对二维地图的网格划分,根据每个网格与障碍物的距离设置每个网格的代价值,网格与障碍物距离越近代价值越大,代价值的取值范围为O~255,再采用Di jkstra算法获得代价地图上一条代价值最小的路径,即为无人机规划出来的路径。
【文档编号】G05D1/10GK103941750SQ201410182840
【公开日】2014年7月23日 申请日期:2014年4月30日 优先权日:2014年4月30日
【发明者】吴成东, 常雪枫, 王璐, 王 琦 申请人:东北大学
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1