CN106226780B - 基于激光扫描雷达的多旋翼室内定位系统及实现方法 - Google Patents
基于激光扫描雷达的多旋翼室内定位系统及实现方法 Download PDFInfo
- Publication number
- CN106226780B CN106226780B CN201610597526.1A CN201610597526A CN106226780B CN 106226780 B CN106226780 B CN 106226780B CN 201610597526 A CN201610597526 A CN 201610597526A CN 106226780 B CN106226780 B CN 106226780B
- Authority
- CN
- China
- Prior art keywords
- laser radar
- scanning laser
- aerial vehicle
- unmanned aerial
- rotor unmanned
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 15
- 238000012544 monitoring process Methods 0.000 claims abstract description 14
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims abstract description 11
- 238000012545 processing Methods 0.000 claims abstract description 7
- 238000005516 engineering process Methods 0.000 abstract description 5
- 238000011160 research Methods 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 3
- 230000001186 cumulative effect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000033001 locomotion Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 241000208340 Araliaceae Species 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000007306 turnover Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种基于激光扫描雷达的多旋翼无人机室内定位系统及实现方法,属于导航定位与控制技术领域。定位系统包括位置采集模块、无线传输模块、飞行控制模块和地面监测模块,位置采集模块包括激光扫描雷达、二轴云台和数据处理计算机。该系统的实现方法先用位置采集模块对室内环境建模,将每次扫描所得的信息与所建模型对比,识别并跟踪多旋翼无人机。通过无线传输模块将位置信息发送给多旋翼无人机,从而可进行室内导航等功能的开发,从地面监测模块实时监测多旋翼无人机的飞行数据。本发明将二维激光雷达与二轴云台相结合,实现对整个空间的扫描,相比三维雷达成本低,且具有较高的定位精度,实现简单,稳定性好。
Description
技术领域
本发明涉及一种基于激光扫描雷达的多旋翼室内定位系统及实现方法,属于导航定位与控制技术领域。
背景技术
由于科学水平的进步,无人机所涉及的领域越来越广,无论是在军事还是民用领域,都具有十分广阔的应用前景。无人机研究的第一步就是对其进行定位与导航。目前国内外研究的用于无人机的定位导航主要技术包括:惯性导航系统(Inertial NavigationSystem,INS)、全球定位系统(Global Position System,GPS)。惯性导航系统是利用陀螺加速度计等惯性元器件,通过积分得到无人机的导航参数,误差会随着时间的推移不断累加。随着科学技术的发展,以及人们对于无人机更轻便,适用范围更广的需求,现今的多旋翼无人机朝着微型化的方向发展,它的活动区域已经延伸至森林,居民区还有室内空间。而在这些区域内,噪声的干扰以及信号的不稳定,使得全球定位系统无法准确得到无人机的位置参数,从而使无人机无法正确的自主导航。所以,如何应用传感器对室内,或者更加危险多变的环境下的无人机进行定位,已经变成了各个国家的重点研究课题。其中,激光扫描雷达因为其稳定性强,结构简单,成为了当下无人机定位研究的热点。
我国用激光扫描雷达对多旋翼无人机进行室内定位的技术还是有很多不完善的地方,有显著提高的空间。所以设计一套能够进行准确定位,并且功能齐全,稳定性高的基于激光扫描雷达的多旋翼无人机室内定位系统,意义重大。
发明内容
本发明针对目前多旋翼无人机室内定位不准确、不稳定的问题,提出一种基于激光扫描雷达的多旋翼室内定位系统及实现方法,获取多旋翼无人在室内定位的相对位置,解决了多旋翼无人机室内导航的关键难点,从而可进一步开发多旋翼无人机室内导航等功能,适用于较为空旷,障碍物不多的室内环境。
本发明为解决其技术问题采用如下技术方案:
一种基于激光扫描雷达的多旋翼室内定位系统,包括位置采集模块、无线传输模块、飞行控制模块和地面监测模块,其中,位置采集模块通过无线传输模块与飞行控制模块连接,飞行控制模块通过无线传输模块与地面监测模块连接;
所述位置采集模块包括激光扫描雷达、二轴云台和数据处理计算机,数据处理计算机读取激光扫描雷达测得的位置信息和二轴云台的俯仰角,经过数据处理将俯仰角控制信号发送给二轴云台。
所述无线传输模块包括两对不同频率的无线数传。
所述无线数传的频率为433MHz和915MHz.
基于激光扫描雷达的多旋翼室内定位系统的实现方法,包括如下步骤:
步骤1,将二轴云台靠墙放置在中间位置,激光雷达置于云台顶部,给云台设置俯仰角0°~60°,激光扫描雷达在三维空间不断扫描,对采集的数据进行处理,建立室内环境模型;
步骤2,检测时将每次扫描的结果与所建模型比较,当检测到多旋翼无人机,利用云台的俯仰角、激光扫描雷达返回的数据进行几何解算,计算多旋翼无人机相对于云台和激光扫描雷达的空间三维位置信息;
步骤3,将该位置信息通过无线传输模块发送给飞行控制模块,再通过无线传输模块从地面监测模块实时监测多旋翼无人机的飞行数据。
步骤2所述的多旋翼无人机相对于云台和激光扫描雷达的空间三维位置信息的计算公式如下,以激光扫描雷达和云台所处位置为原点建立坐标系,x轴平行于墙面向右,y轴指向室内,z轴垂直于地面向上:
α表示云台转过的俯仰角,d表示激光扫描雷达测得的距离,β表示相对于雷达正前方的偏转角度,向右为正,h0为云台和激光扫描雷达的高度。
本发明的有益效果如下:
1、本发明利用激光扫描雷达和二轴云台实现了多旋翼无人机的高精度室内定位,解决了室内定位的难题,在较为空旷的室内具有较好的定位效果。
2、现有的室内定位技术主要为视觉定位,多为累计误差,精度较差,易受光照变化的影响,而本发明采用高精度激光扫描雷达,且多旋翼无人机机身越小,定位精度越高。
3、本发明具有控制简单,精度高,稳定性好,速度快、易操作等优点,易于工程实现。
附图说明
图1是本发明基于激光扫描雷达的多旋翼无人机室内定位系统的整体框架图。
图2是二维激光扫描雷达的测量模型示意图。
图3是本发明基于激光扫描雷达的多旋翼无人机室内定位方法的流程图。
图4是多旋翼无人机与激光扫描雷达和二轴云台的位置关系图。
具体实施方式
下面详细描述本发明的实施方式,所述实施方式的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施方式是示例性的,仅用于解释本发明,而不能解释为对本发明的限制。
本发明基于激光扫描雷达的多旋翼无人机室内定位系统,包括位置采集模块、无线传输模块、飞行控制模块和地面监测模块,位置采集模块包括激光扫描雷达、高精度二轴云台(PTU)和数据处理器。整套系统的布置如图1所示,二轴云台靠墙放置在中间位置,激光扫描雷达置于云台顶部。所采用的二维激光扫描雷达是HOKUYO的UTM-30LX,具有0.25°的角分辨率,扫描角度270°,激光扫描雷达水平放置时的测量模型如图2所示,激光扫描雷达返回的是一个数组,共1081个数据:data(扫描平面内物体到激光雷达的距离)[0]~data[1080],结合数据序号和0.25°的角分辨率可以得到物体相对于激光扫描雷达的角度。从OA方向扫描至OB方向,共270°,实际所需的角度为0C至OD的180°,即data[180]~data[900](该180°平面内物体到激光扫描雷达的距离)。假设点P处返回的数据为data[p](P点到激光扫描雷达的距离),则θ=135-p*0.25,OP=data[p](P点到激光扫描雷达的距离),即有:
x值为负即表示该点在激光扫描雷达的左边。
给云台设置一定的俯仰角,云台从0°到60°转动,对激光扫描雷达的数据结合云台转过的俯仰角进行处理,得到室内的模型。至此,完成室内环境的建模,这是实现室内定位的准备工作。如图3基于激光扫描雷达的多旋翼无人机室内定位方法的流程图所示,每扫描一次,对比于所建模型,判断是否检测到多旋翼无人机。若检测到,取其中点,如图4所示,P点即表示多旋翼无人机中心,O点是激光扫描雷达,α代表二轴云台转过的俯仰角,β代表多旋翼无人机中心与激光扫描雷达正前方的夹角,d为测得的多旋翼无人机到激光扫描雷达的距离,以激光扫描雷达和二轴云台的位置为原点建立坐标系,x轴为平行于墙面向右,y轴指向室内,z轴垂直于地面向上。则在该坐标系下,多旋翼无人机相对于激光扫描雷达的空间位置信息x,y,z为:
其中h0为二轴云台和激光扫描雷达的高度。
随着多旋翼无人机的移动,调整二轴云台的俯仰角,使多旋翼无人机始终在激光扫描雷达的扫描范围内。
通过915MHz的3DR无线数传将位置信息发送给飞行控制模块,由另一对433MHz的3DR无线数传将多旋翼无人机的位置信息发送给地面监测系统,从而对多旋翼无人机的位置进行实时监测。采用两对不同频率的无线数传,有效防止无线数传之间的信息干扰。
如没有检测到多旋翼无人机,则继续转动二轴云台,直至检测到多旋翼无人机。
以上实施例仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明保护范围之内。
Claims (2)
1.一种基于激光扫描雷达的多旋翼室内定位系统的实现方法,其特征在于,该方法采用的定位系统包括位置采集模块、无线传输模块、飞行控制模块和地面监测模块,其中,位置采集模块通过无线传输模块与飞行控制模块连接,飞行控制模块通过无线传输模块与地面监测模块连接;
所述位置采集模块包括激光扫描雷达、二轴云台和数据处理计算机,数据处理计算机读取激光扫描雷达测得的位置信息和二轴云台的俯仰角,经过数据处理将俯仰角控制信号发送给二轴云台;所述无线传输模块包括两对不同频率的无线数传;所述无线数传的频率为433MHz和915MHz;
该方法包括如下步骤:
步骤1,将二轴云台靠墙放置在中间位置,激光雷达置于云台顶部,给云台设置俯仰角0°~60°,激光扫描雷达在三维空间不断扫描,对采集的数据进行处理,检测多旋翼无人机;
步骤2,当检测到多旋翼无人机,利用云台的俯仰角、激光扫描雷达返回的数据进行几何解算,计算多旋翼无人机相对于云台和激光扫描雷达的空间三维位置信息;
步骤3,将该位置信息通过无线传输模块发送给飞行控制模块,再通过无线传输模块从地面监测模块实时监测多旋翼无人机的飞行数据。
2.根据权利要求1所述的基于激光扫描雷达的多旋翼室内定位系统的实现方法,其特征在于,步骤2所述的多旋翼无人机相对于云台和激光扫描雷达的空间三维位置信息的计算公式如下,以激光扫描雷达和云台所处位置为原点建立坐标系,x轴平行于墙面向右,y轴指向室内,z轴垂直于地面向上:
表示云台转过的俯仰角,d表示激光扫描雷达测得的距离,表示相对于雷达正前方的偏转角度,向右为正,为云台和激光扫描雷达的高度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610597526.1A CN106226780B (zh) | 2016-07-26 | 2016-07-26 | 基于激光扫描雷达的多旋翼室内定位系统及实现方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610597526.1A CN106226780B (zh) | 2016-07-26 | 2016-07-26 | 基于激光扫描雷达的多旋翼室内定位系统及实现方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106226780A CN106226780A (zh) | 2016-12-14 |
CN106226780B true CN106226780B (zh) | 2019-02-05 |
Family
ID=57534319
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610597526.1A Expired - Fee Related CN106226780B (zh) | 2016-07-26 | 2016-07-26 | 基于激光扫描雷达的多旋翼室内定位系统及实现方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106226780B (zh) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108253966B (zh) * | 2016-12-28 | 2021-08-06 | 昊翔电能运动科技(昆山)有限公司 | 无人机飞行三维模拟显示方法 |
CN108303088A (zh) * | 2017-01-12 | 2018-07-20 | 日之阳(北京)仪器制造有限公司 | 一种用于多旋翼飞行器的定位系统 |
US10725171B2 (en) * | 2017-01-27 | 2020-07-28 | Massachusetts Institute Of Technology | Method and system for localization of a vehicle using surface penetrating radar |
CN108535736A (zh) * | 2017-03-05 | 2018-09-14 | 苏州中德睿博智能科技有限公司 | 三维点云数据获取方法及获取系统 |
CN108828576B (zh) * | 2018-04-10 | 2023-04-25 | 上海摩软通讯技术有限公司 | 室内定位系统和方法 |
CN108919297A (zh) * | 2018-05-18 | 2018-11-30 | 国网山东省电力公司青岛供电公司 | 一种无人机室内定位系统及方法 |
CN108562289B (zh) * | 2018-06-07 | 2021-11-26 | 南京航空航天大学 | 连续多边几何环境中四旋翼飞行器激光雷达导航方法 |
CN109362127A (zh) * | 2018-11-12 | 2019-02-19 | 新疆联海创智信息科技有限公司 | 一种无线电磁信号扫描定位系统及方法 |
CN111436050B (zh) * | 2019-01-11 | 2022-04-05 | 华为技术有限公司 | 无线网络通信方法、网络设备和终端 |
CN111486841B (zh) * | 2020-05-19 | 2022-04-05 | 西安因诺航空科技有限公司 | 一种基于激光定位系统的无人机导航定位方法 |
CN112379386B (zh) * | 2020-09-30 | 2024-01-02 | 中国人民解放军陆军炮兵防空兵学院 | 一种无人蜂群目标空间位置分布探测系统及方法 |
CN113029158B (zh) * | 2021-04-26 | 2023-09-22 | 常州大学 | 基于激光与声音融合定位的旋翼飞行器及其定位方法 |
CN113178767A (zh) * | 2021-05-28 | 2021-07-27 | 北京同方华光系统科技有限公司 | 一种多光束多维度扫描的激光杀毒杀菌装置和方法 |
CN115390051B (zh) * | 2022-10-27 | 2023-03-24 | 深圳煜炜光学科技有限公司 | 激光雷达标定方法、装置、设备及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104656097A (zh) * | 2015-01-28 | 2015-05-27 | 武汉理工大学 | 基于旋转式二维激光三维重构系统的标定装置及方法 |
CN104833354A (zh) * | 2015-05-25 | 2015-08-12 | 梁步阁 | 一种多基多模组网融合室内人员导航定位系统及其实施方法 |
CN204945409U (zh) * | 2015-08-29 | 2016-01-06 | 西安希德电子信息技术股份有限公司 | 一种对铁路障碍进行自动监测的三维激光雷达报警系统 |
CN105460210A (zh) * | 2015-12-04 | 2016-04-06 | 上海浦江桥隧大桥管理有限公司 | 用于桥梁检测的便携式六旋翼飞行器 |
CN205880223U (zh) * | 2016-07-26 | 2017-01-11 | 南京航空航天大学 | 基于激光扫描雷达的多旋翼室内定位系统 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11287651A (ja) * | 1998-04-02 | 1999-10-19 | Kaijo Corp | 屋内位置決め装置 |
-
2016
- 2016-07-26 CN CN201610597526.1A patent/CN106226780B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104656097A (zh) * | 2015-01-28 | 2015-05-27 | 武汉理工大学 | 基于旋转式二维激光三维重构系统的标定装置及方法 |
CN104833354A (zh) * | 2015-05-25 | 2015-08-12 | 梁步阁 | 一种多基多模组网融合室内人员导航定位系统及其实施方法 |
CN204945409U (zh) * | 2015-08-29 | 2016-01-06 | 西安希德电子信息技术股份有限公司 | 一种对铁路障碍进行自动监测的三维激光雷达报警系统 |
CN105460210A (zh) * | 2015-12-04 | 2016-04-06 | 上海浦江桥隧大桥管理有限公司 | 用于桥梁检测的便携式六旋翼飞行器 |
CN205880223U (zh) * | 2016-07-26 | 2017-01-11 | 南京航空航天大学 | 基于激光扫描雷达的多旋翼室内定位系统 |
Also Published As
Publication number | Publication date |
---|---|
CN106226780A (zh) | 2016-12-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106226780B (zh) | 基于激光扫描雷达的多旋翼室内定位系统及实现方法 | |
CN107186548B (zh) | 一种五轴数控机床回转轴几何误差检测方法 | |
CN105157697B (zh) | 基于光电扫描的室内移动机器人位姿测量系统及测量方法 | |
CN106772493B (zh) | 基于北斗差分定位的无人机航向测算系统及其测算方法 | |
CN109807911B (zh) | 基于gnss、uwb、imu、激光雷达、码盘的室外巡逻机器人多环境联合定位方法 | |
Huang et al. | Accurate 3-D position and orientation method for indoor mobile robot navigation based on photoelectric scanning | |
CN108919825A (zh) | 具备避障功能的无人机室内定位系统及方法 | |
CN102901977B (zh) | 一种飞行器的初始姿态角的确定方法 | |
CN101413785B (zh) | 基于双旋转激光平面发射机网络的定位系统误差补偿方法 | |
CN108844539A (zh) | 一种用于海浪主动补偿系统的位姿检测系统 | |
CN109238247B (zh) | 一种面向大空间复杂现场的六自由度测量方法 | |
CN103278132B (zh) | 自行走式地下掘进机器人姿态测量装置及其测量方法 | |
CN110018450A (zh) | Ais与雷达角度系统偏差的关联校准方法 | |
CN111694001A (zh) | 一种用于无人机的实时测距定位系统 | |
CN107817003B (zh) | 一种分布式大尺寸空间定位系统的外参数标定方法 | |
CN112269202A (zh) | 一种运动载体辅助的空间基准传递系统及方法 | |
CN110220533A (zh) | 一种基于传递对准的机载光电吊舱设备失准角标定方法 | |
CN105823420A (zh) | 一种角锥组合件回光能量中心坐标精密导出方法 | |
CN102818566A (zh) | 一种船舶定位方法及装置 | |
CN108362493A (zh) | 一种数控机床直线轴转角误差快速检测方法 | |
CN107797131A (zh) | 基于gps载波相位姿态的无人船数据融合姿态测量方法 | |
CN101696880A (zh) | 运动载体动态实时精密水平测量方法 | |
CN113587819A (zh) | 一种基于三路激光跟踪的大尺度空间位姿动态测量方法与测量精度验证方法 | |
CN110871824B (zh) | 一种轨道周围环境监测方法及系统 | |
CN116027804B (zh) | 无人机地面光电测控引导装置以及引导方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20190205 Termination date: 20200726 |