一种基于激光扫描地图构建系统的四轴飞行器及其方法专利检索-超声波扫描仪诊断设备和程序专利检索查询-专利查询网

一种基于激光扫描地图构建系统的四轴 飞行器及其方法

阅读：917发布：2020-05-16

专利汇可以提供一种基于激光扫描地图构建系统的四轴飞行器及其方法专利检索，专利查询，专利分析的服务。并且本发明公开了一种基于激光扫描地图构建系统的四轴飞行器及其方法。该四轴飞行器包括机架、处理器模块、传感器模块；其中，机架包括螺旋桨、无刷电机、支撑脚、机臂轴和载板，处理器模块包括飞控中心和树莓派，飞控中心与树莓派通过串口通信构成自动避障系统，传感器模块包括超声波传感器以及激光扫描仪；树莓派与超声波传感器电连接构成超声测距系统，通过超声波传感器获得障碍物的相对距离；树莓派与激光扫描仪通过USB线电连接组成地图构建系统，通过激光扫描仪采集飞行器周围的环境信息。本发明具有根据室内环境自主规划路径、自主避障与自主导航飞行能力，能够获取不同高度上的二维地图，具有作业能力强、智能化程度高、效率高等优点。，下面是一种基于激光扫描地图构建系统的四轴飞行器及其方法专利的具体信息内容。

权利要求

1.一种基于激光扫描地图构建系统的四轴飞行器，其特征在于，包括机架、处理器模块、传感器模块；
其中，所述机架包括螺旋桨（1）、无刷电机（2）、支撑脚（3）、机臂轴（4）和载板（6），所述机架从下向上分别设置有三层载板（6），第一层载板和第二层载板之间设置有呈十字形交叉的四个机臂轴（4），形成机架主体；每个机臂轴（4）的端部固定安装有螺旋桨（1）和用于驱动螺旋桨（1）转动的无刷电机（2），无刷电机（2）下方设置有支撑脚（3）；
所述处理器模块包括设置在第二层载板上的飞控中心（7）和树莓派（8），所述飞控中心（7）与树莓派（8）通过串口通信构成自动避障系统；
所述传感器模块包括设置在第一层载板上的超声波传感器（9）以及设置在第三层载板中央的激光扫描仪（10）；
所述树莓派（8）配置有ROS 操作系统；所述树莓派（8）与超声波传感器（9）电连接构成超声测距系统；所述树莓派（8）与激光扫描仪（10）通过USB线电连接组成地图构建系统。
2.根据权利要求1所述基于激光扫描地图构建系统的四轴飞行器，其特征在于，所述超声波传感器（9）设置在第一层载板上的前、后、左、右、下五个正方向。
3.根据权利要求1所述基于激光扫描地图构建系统的四轴飞行器，其特征在于，所述支撑脚（3）由不同形状的固定板组成；不同形状的固定板之间相互卡紧。
4.根据权利要求3所述基于激光扫描地图构建系统的四轴飞行器，其特征在于，所述固定板包括水平设置并且与机臂轴（4）线平行的第一固定板（31）、竖直设置的第二固定板（32）、水平设置并且与机臂轴（4）线垂直的第三固定板（33）；第一固定板（31）用于固定无刷电机（2），同时与机臂轴（4）固定连接；第二固定板（32）卡紧第一固定板（31）；第三固定板（33）卡紧第二固定板（32）。
5.根据权利要求4所述基于激光扫描地图构建系统的四轴飞行器，其特征在于，第一层载板和第二层载板之间设有用于固定机臂轴（4）的轴夹（5），所述机臂轴（4）通过螺栓和轴夹（5）固定连接。
6. 根据权利要求1所述基于激光扫描地图构建系统的四轴飞行器，其特征在于，第二层载板与第三层载板之间的距离为40～60 mm。
7.根据权利要求1所述基于激光扫描地图构建系统的四轴飞行器，其特征在于，第一层载板与第二层载板之间通过螺栓和轴夹连接。
8.根据权利要求1所述基于激光扫描地图构建系统的四轴飞行器，其特征在于，第二层载板与第三层载板之间通过螺钉和铜柱连接。
9.一种构建室内地图的方法，其特征在于，使用权利要求1～6中任意一项所述基于激光扫描地图构建系统的四轴飞行器进行室内地图的构建。
10.根据权利要求9所述的方法，其特征在于，所述四轴飞行器在树莓派（8）中实现粒子滤波算法，利用所得到的信息完成自身位置估计，同时基于此信息，创建所处环境的栅格地图，实现即时定位与地图构建。

说明书全文

一种基于激光扫描地图构建系统的四轴飞行器及其方法

技术领域

[0001] 本发明属于无人机技术领域。更具体地，涉及一种基于激光扫描地图构建系统的四轴飞行器及其方法。

背景技术

[0002] 四轴飞行器电子系统可由传感器及飞行控制两个子系统组成；传感器系统需要对无人机状态进行精确测量或估计，其将无人机位置、速度、姿态角、角速度等飞行状态传递给飞行控制子系统，并由其实现良好的飞行控制；传感器系统可细分为姿态传感器及位置传感器两类；常用姿态传感器由三轴加速度计、三轴陀螺仪、磁力计等MEMS元件组成，其在室内外均可使用；位置传感器则多采用GPS、北斗等卫星定位导航系统，然而该种传感器难以在GPS 信号微弱的楼群间及室内环境中实现精确定位；国际上为解决无GPS环境下精确定位问题，常用方法可分为基于VICON等运动捕获系统定位，基于机载摄像头定位及基于机载激光雷达定位三种；利用激光雷达作为机载位置传感器，相较于其他方法，具有定位精度高、对环境依赖程度较弱、利于向室外扩展等优势，是国际控制领域研究的热点问题。

[0003] 室内地图构建装置主要有固定平台和移动机器人两种，基于固定平台的室内地图构建装置可以对距离相对固定的物体进行重构，由于其不可以移动，导致分辨率单一；移动机器人与激光扫描仪等测距模块配合使用虽然也可应用于室内环境的地图构建，但是有些室内的地面环境情况复杂，例如室内环境污染、火灾或有军事威胁等，存在着轮式机器人或履带机器人的移动不便的情况，从而导致了工作效率低甚至是无法工作。而且，一般的轮式机器人因不能爬楼梯，只能在某一楼层范围内进行探索，移动范围受到了限制；具有爬楼梯能力的履带机器人体型较大，在某些转角会出现转弯不便的情况，移动速度或范围都受到了限制，无法实现复杂环境的侦察和构图，从而影响了其应用价值与使用范围。另外，在轮式机器人或履带机器人的平台上，大多数激光扫描仪被固定在某一高度，使得创建的地图被局限于某一水平面上，导致环境信息的获取量被限制了。

发明内容

[0004] 本发明要解决的技术问题是克服上述现有技术的不足，提供一种基于激光扫描地图构建系统的四轴飞行器。

[0005] 本发明另一目的是提供使用所述基于激光扫描地图构建系统的四轴飞行器构建室内地图的方法。

[0006] 本发明上述目的通过以下技术方案实现：一种基于激光扫描地图构建系统的四轴飞行器，包括机架、处理器模块、传感器模块；
其中，所述机架包括螺旋桨、无刷电机、支撑脚、机臂轴和载板，所述机架从下向上分别设置有三层载板，第一层和第二层载板之间设置有呈十字形交叉的四个机臂轴，形成机架主体；每个机臂轴的端部固定安装有螺旋桨和用于驱动螺旋桨转动的无刷电机，各螺旋桨和无刷电机匹配使用；所述无刷电机下方设置有支撑脚；
所述处理器模块包括设置在第二层载板上的飞控中心和树莓派，所述飞控中心与树莓派通过串口通信构成自动避障系统；
所述传感器模块包括设置在第一层载板上的超声波传感器以及设置在第三层载板中央的激光扫描仪；
所述树莓派与超声波传感器电连接构成超声测距系统；所述树莓派与激光扫描仪通过USB线电连接组成地图构建系统，通过激光扫描仪采集飞行器周围的环境信息；所述飞控中心会执行来自树莓派与地面站的控制指令，实现整个飞行器的空中飞行、悬停、定位和姿态控制。

[0007] 本发明利用四轴飞行器作为移动平台，并设置有飞控中心，树莓派与超声波传感器组成测距系统，通过超声波传感器获得障碍物的相对距离，由树莓派分析飞行器与障碍物的相对距离，结合飞行器的运动状态，以规避飞行中与障碍物碰撞；树莓派与激光扫描仪组成地图构建系统，通过激光扫描仪采集飞行器周围的环境信息；树莓派与飞控中心通过串口通信构成自动避障系统，树莓派根据障碍物的距离信息向飞控中心传送飞行控制指令，基于树莓派的ROS系统与粒子滤波技术对激光扫描数据处理并且采用栅格模型构建地图。

[0008] 本发明有针对性的将超声波传感器测距技术、激光雷达扫描技术与四轴飞行器进行结合，发挥各自优势，同时突破未知内地面环境复杂使普通地面机器人无法进入的难题，具有根据室内环境自主规划路径与自主导航飞行能力，自主避免与室内墙壁或障碍物碰撞，同时提高室内地图构建的分辨率，具有作业能力强、智能化程度高、效率高等优点。

[0009] 优选地，所述超声波传感器设置在第一层载板上的前、后、左、右、下五个正方向。位于飞行器五个正方向的超声波传感器实时检测飞行器与前方、侧面、地面或下方物体的相对距离，一方面用于与下方物体或地面保持安全距离，另一方面用于在安全距离的范围内，用户可调节飞行器在不同高度的悬停以进行扫描构建地图。

[0010] 优选地，所述支撑脚由不同形状的固定板组成；不同形状的固定板之间相互卡紧。

[0011] 更优选地，所述固定板包括水平设置并且与机臂轴线平行的第一固定板、竖直设置的第二固定板、水平设置并且与机臂轴线垂直的第三固定板；第一固定板用于固定无刷电机，同时与机臂轴固定连接；第二固定板卡紧第一固定板；第三固定板卡紧第二固定板。

[0012] 本发明所述固定板为亚克力切割板。

[0013] 优选地，第一层和第二层载板之间设有用于固定机臂轴的轴夹，所述机臂轴通过螺栓和轴夹固定连接。

[0014] 优选地，第二层载板与第三层载板之间的距离为40～60 mm。

[0015] 更优选地，第二层载板与第三层载板之间的距离为50 mm。

[0016] 优选地，第一层载板、第二层载板与第三层载板之间相互平行。

[0017] 优选地，第一层载板与第二层载板之间通过螺栓和轴夹连接。

[0018] 优选地，第二层载板与第三层载板之间通过螺钉和铜柱连接。

[0019] 优选地，所述飞控中心为PIX4飞控中心。

[0020] 优选地，所述飞控中心的处理器为STM32处理器。

[0021] 优选地，所述机架的尺寸为420 mm × 420 mm（包括螺旋桨的旋转范围）。

[0022] 优选地，所述超声波传感器的Trig引脚与树莓派主板的GPIO2（Pin3）连接，Echo引脚先连接一个1 k 电阻再进一步连接树莓派主板的GPIO3（Pin5），在连接1 k电阻与GPIO3之间的线路引出一个带2 k电阻的电路接到GND，1 k和2 k电阻组成了一个分压电路，使GPIO3脚的电压降到了3.3 v左右。

[0023] 优选地，所述树莓派主板的TXD0（Pin8）、RXD0（Pin10）引脚分别与飞控中心的STM32芯片的USART1_RX（PA10）与USART1_TX（PA9）引脚电连接。

[0024] 优选地，所述树莓派配置有ROS 操作系统。

[0025] 本发明同时设置有测距系统、地图构建系统和自动避障系统，本发明还提供了使用所述的基于激光扫描地图构建系统的四轴飞行器进行构建室内地图的方法。

[0026] 优选地，所述四轴飞行器在树莓派中实现粒子滤波算法，利用所得到的信息完成自身位置估计，同时基于此信息，创建所处环境的栅格地图，实现即时定位与地图构建。

[0027] 具体优选地，所述即时定位与地图构建的运行方法，包括以下步骤：S11. 在树莓派8的ROS GMapping包中，获取激光扫描数据传入openslam GMapping包中，为新一时刻的建图做准备；
S12. 根据t-1时刻的粒子位姿数据，预测t时刻的粒子位姿，在初始值的基础上增加高斯采样的噪声估计；
S13. 采用30个采样粒子，对每个粒子执行扫描匹配算法，找到每个粒子在t时刻位姿的最佳坐标，即每个粒子将会产生一个与之相对应的预测粒子，为后面每个粒子权重更新做准备；
S14. 通过粒子滤波算法对预测粒子进行评价，越接近于真实状态的粒子，其权重越大，反之，与真实值相差较大的粒子，其权重越小；
S15. 根据粒子权重对粒子进行筛选，筛选过程中，大量保留权重大的粒子的同时又要有一小部分权重小的粒子，就在权值较高的粒子附近加入一些新的粒子，保证粒子总数不变；
S16. 将重采样后的粒子又执行扫描匹配算法得到新的预测粒子，然后将它们继续进行步骤S14和步骤S15的过程，经过这种循环迭代，最终绝大部分粒子会聚集在与真实值最接近的区域内，从而得到飞行器的准确位置，实现准确定位；同时，每个粒子都携带一个路径地图，综合整个运算过程选取最优的粒子，即可获得规划区域的栅格地图；
S17. 地面站通过无线方式向飞行器发送控制指令，调整飞行器在室内的高度，重复步骤S11至步骤S16，实现不同高度上的多分辨的室内地图构建。

[0028] 所述步骤S14中，飞行器在移动时，激光扫描仪会返回周围的位置信息，如果这些信息与期望值相差较大，或者在运动中某些粒子本应该没有碰到障碍或者边界，然而在运算中却到达甚至穿过了障碍点或边界，该种粒子为坏点粒子，需要降低该粒子权重。不断进行循环迭代，逐步减小误差，完成飞行器自定位和地图构建。

[0029] 所述树莓派根据障碍物的距离信息向飞控中心传送飞行控制指令，包括：若检测到超声波传感器与障碍物的距离差值稳定在预设范围内，则树莓派通过指令使四轴飞行器自动悬停，等待操作者发送动作指令；若检测到某方向上的超声波传感器与障碍物的距离小于该相对方向上的障碍物距离，则所述飞控中心增大该方向上的两个无刷电机的转速，使四轴飞行器往障碍物距离较大的一方移动，从而使得四轴飞行器保持在障碍物与障碍物之间的中央范围。

[0030] 更优选地，所述四轴飞行器两端的距离的差值稳定在预设的0～15 cm范围内。

[0031] 进一步优选地，自动避障系统的避障指令的优先级高于遥控飞行指令的优先级，防止人为因素导致飞行器撞上障碍物。

[0032] 构建的栅格地图在树莓派的ROS系统生成，通过带ROS系统的用户电脑与所述树莓派的ROS系统建立远程连接，运行相关指令，可在带ROS系统的用户电脑实时看到飞行器携带激光扫描仪进行地图构建的过程。

[0033] 本发明中，飞控中心和树莓派除了控制飞行器本身的稳定性之外，通过超声波传感器和激光扫描仪测定飞行器的姿态、航向、飞行速度，结合近处障碍物位置与分布、环境图像的特征、环境图像的分析，确定每一步的前进方向、前进速度、避障移动，把飞行器的运动计算与环境计算综合分析，以确定飞行器的飞行控制与导航路线。

[0034] 与现有技术相比，本发明具有如下有益效果：本发明的四轴飞行器机动性能好，搭载激光扫描仪获取环境的数据速度快、效率高；超声波测距系统能够实时感知飞行器与室内障碍物的相对距离，结合飞行控制系统，实时调整飞行器保持在障碍物与障碍物之间的中间范围移动，保障其安全性，并且为路径规划提供技术基础；同时，四轴飞行器能够方便且准确地调整高度，扫描不同的水平面，获取不同高度上的二维地图，从而能够获取更多的环境信息，其具有很好的实用价值。
附图说明

[0035] 图1为基于激光扫描地图构建系统的四轴飞行器的轴侧视图。

[0036] 图2为基于激光扫描地图构建系统的四轴飞行器的主视图。

[0037] 图3为支撑脚的结构示意图。

[0038] 图4为基于激光扫描地图构建系统的四轴飞行器的电性连接示意图。

[0039] 其中，1-螺旋桨；2-无刷电机；3-支撑脚；4-机臂轴；5-轴夹；6-载板；7-PIX4飞控中心；8-树莓派；9-超声波传感器；10-激光扫描仪；31-第一固定板；32-第二固定板；33-第三固定板。

具体实施方式

[0040] 以下结合具体实施例来进一步说明本发明，附图仅用于示例性说明，不能理解为对本专利的限制；为了更好说明本实施例，附图某些部件会有省略、放大或缩小，并不代表实际产品的尺寸；对于本领域技术人员来说，附图中某些公知结构及其说明可能省略是可以理解的。附图中描述位置关系仅用于示例性说明，不能理解为对本专利的限制。

[0041] 实施例1下面对本发明的技术方案进行详细说明：
1、一种基于激光扫描地图构建系统的四轴飞行器
（1）一种基于激光扫描地图构建系统的四轴飞行器的总体结构如图1和图2所示，包括机架、处理器模块、传感器模块。该机架尺寸为420 mm × 420 mm（包括螺旋桨的旋转范围），包括螺旋桨1、无刷电机2、支撑脚3、机臂轴4、轴夹5和载板6。

[0042] 其中，螺旋桨1安装在无刷电机2上方并用六角薄螺母锁紧；支撑脚3的上方设置有无刷电机2、往机架中心方向设置有机臂轴4，该机臂轴4通过四个轴夹5与螺栓固定在第一、第二层载板的中间，呈十字形交叉形，形成了机架的主体；在第二层载板上方附加性的设置有第三层载板，第三层载板与第二层载板之间的距离为50 mm。

[0043] 如图3所示，支撑脚3由六块三种不同形状的固定板组成；不同形状的固定板之间相互卡紧；具体是：水平方向设置并且与机臂轴线平行的第一固定板31用于固定无刷电机2，并且同时通过三个螺栓固定连接于机臂轴4；竖直方向设置的第二固定板32用于卡紧第一固定板31；而水平方向设置并且与机臂轴4线垂直的第三固定板33用于卡紧竖直方向设置的第二固定板32。本实施例中固定板为亚克力切割板。

[0044] （2）本实施例的处理器模块包括以STM32为处理器的PIX4飞控中心7和树莓派8，飞控中心7和树莓派8均设置在机架的第二层载板上；传感器模块包括设置在第一层载板的前、后、左、右、下五个正方向上的超声波传感器9和设置在第三层载板的中央激光扫描仪10；树莓派8与超声波传感器9组成测距系统，通过超声波传感器9获得障碍物的相对距离，由树莓派8分析飞行器与障碍物的相对距离，结合飞行器的运动状态，以规避飞行中与障碍物碰撞；树莓派8与激光扫描仪10组成地图构建系统，通过激光扫描仪10采集飞行器周围的环境信息；PIX4飞控中心7会执行来自树莓派与地面站的控制指令；树莓派8与PIX4飞控中心7通过串口通信构成自动避障系统，树莓派8根据障碍物的距离信息向PIX4飞控中心7传送飞行控制指令，基于树莓派8的ROS系统与粒子滤波技术对激光扫描数据处理并且采用栅格模型构建地图。

[0045] （3）图2为主视图，即为飞行器的前方，如图4所示，飞行器前方的超声波传感器9的Trig引脚与树莓派主板8的GPIO2（Pin3）连接，Echo引脚先连接一个1 k电阻再进一步连接树莓派主板8的GPIO3（Pin5），在连接1 k电阻与GPIO3之间的线路引出一个带2 k电阻的电路接到GND，1 k和2 k电阻组成了一个分压电路，使GPIO3脚的电压降到了3.3 v左右；GPIO2设为输出模式，GPIO3设为输入模式，树莓派8向Trig脚发送一个10 us的脉冲信号，接收到这个脉冲后，HC-SR04发射出超声波，同时把Echo置为高电平（在发射之前，Echo一直为低电平），然后准备接收返回的超声波，接受超声波之后Echo为低电平，得到超声波从发射到返回的时间间隔，进一步算出障碍物的距离；其余超声波传感器9包括右方、后方、左方、下方的超声波传感器，按上述方式连接其他的GPIO脚；位于飞行器下方的超声波传感器9实时检测飞行器与地面或下方物体的相对距离，一方面用于与下方物体或地面保持安全距离，另一方面用于在安全距离的范围内，用户可调节飞行器在不同高度的悬停以进行扫描构建地图；树莓派主板8的TXD0（Pin8）、RXD0（Pin10）引脚分别与PIX4飞控中心7的STM32芯片的USART1_RX（PA10）与USART1_TX（PA9）引脚电连接；树莓派8与飞控中心7通过串口通信，激光扫描仪10与树莓派8通过USB线进行电连接。

[0046] 2、一种使用该基于激光扫描地图构建系统的四轴飞行器构建室内地图的方法，包括以下步骤：S1. 同步定位与地图构建；其中，飞行器在树莓派8的ROS系统中实现粒子滤波算法，利用所得到的信息完成自身位置估计，同时基于此信息，创建所处环境的栅格地图，实现飞行器的即时定位与地图构建；
S2. 路径规划与自主避障；树莓派8根据障碍物的距离信息向飞控中心7传送飞行控制指令，包括：若检测到超声波传感器9与障碍物的距离的差值稳定在在预设的0～15 cm范围内，则树莓派8通过指令0X00使飞行器自动悬停，等待操作者发送动作指令；若检测到某方向上的超声波传感器9与障碍物的距离小于该相对方向上的障碍物距离，则飞控中心7增大该方向上的两个无刷电机2的转速，使飞行器往障碍物距离较大的一方移动，从而使得飞行器保持在障碍物与障碍物之间的中央范围；另外，自动避障系统的避障指令的优先级比遥控飞行指令的优先级要高，使得防止人为因素导致飞行器撞上障碍物。

[0047] 具体地，步骤S1的运行步骤包括：（1）在ROS GMapping包中，获取激光扫描数据传入openslam GMapping包中，为新一时刻的建图做准备；
（2）根据t-1时刻的粒子位姿数据，预测t时刻的粒子位姿，在初始值的基础上增加高斯采样的噪声估计（noisypoint）；
（3）采用30个采样粒子，对每个粒子执行扫描匹配算法，找到每个粒子在t时刻位姿的最佳坐标，即每个粒子将会产生一个与之相对应的预测粒子，为后面每个粒子权重更新做准备；
（4）通过算法对预测粒子进行评价，越接近于真实状态的粒子，其权重越大，反之，与真实值相差较大的粒子，其权重越小，飞行器移动过程中，激光雷达会返回周围的位置信息，如果这些信息与期望值相差较大，或者在运动中某些粒子本应该没有碰到障碍或者边界，然而在运算中却到达甚至穿过了障碍点或边界，该种粒子为坏点粒子，需要降低该粒子权重；
（5）根据粒子权重对粒子进行筛选，筛选过程中，大量保留权重大的粒子的同时又要有一小部分权重小的粒子，就在权值较高的粒子附近加入一些新的粒子，保证粒子总数不变；
（6）将重采样后的粒子又执行扫描匹配算法得到新的预测粒子，然后将它们继续进行上述（4）、（5）过程，经过这种循环迭代，最终绝大部分粒子会聚集在与真实值最接近的区域内，从而得到飞行器准确的位置，实现定位；每个粒子都携带一个路径地图，综合整个运算过程选取最优的粒子，即可获得规划区域的栅格地图；
（7）地面站通过无线方式向飞行器发送控制指令，调整飞行器在室内的高度，重复步骤（1）至步骤（7），实现不同高度上的多分辨的室内地图构建。

[0048] 该栅格地图在树莓派8的ROS系统生成，通过带ROS系统的用户电脑与树莓派8的ROS系统建立远程连接，运行相关指令，可在带ROS系统的用户电脑实时看到飞行器携带激光扫描仪10进行地图构建的过程。

标题	发布/更新时间	阅读量
一种实现扫描设备自动扫描的方法及装置	2020-05-19	110
一种扫描仪电路控制装置	2020-05-16	930
用于处理凶险性前置胎盘临床急症的治疗系统	2020-05-18	682
三维超声波扫描仪	2020-05-11	528
无线超声波扫描系统	2020-05-15	744
低外形超声波检查扫描仪	2020-05-12	713
一种基于笼式无人机的电缆隧道故障巡检系统	2020-05-17	951
一种防碰撞AGV激光叉车	2020-05-16	774
圆周全角超声波扫描仪	2020-05-12	919
一种超声波计量带式给料机	2020-05-18	740

一种基于激光扫描地图构建系统的四轴飞行器及其方法

一种基于激光扫描地图构建系统的四轴飞行器及其方法

技术领域

背景技术

发明内容

具体实施方式

该功能需要专业版企业版VIP权限，您可以：