CN105652890B - 一种无人机控制方法和装置 - Google Patents
一种无人机控制方法和装置 Download PDFInfo
- Publication number
- CN105652890B CN105652890B CN201610066533.9A CN201610066533A CN105652890B CN 105652890 B CN105652890 B CN 105652890B CN 201610066533 A CN201610066533 A CN 201610066533A CN 105652890 B CN105652890 B CN 105652890B
- Authority
- CN
- China
- Prior art keywords
- unmanned plane
- operator
- target point
- gps
- security target
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 22
- 230000001235 sensitizing effect Effects 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 7
- 230000008569 process Effects 0.000 description 4
- 230000004888 barrier function Effects 0.000 description 3
- 230000006378 damage Effects 0.000 description 3
- 208000027418 Wounds and injury Diseases 0.000 description 2
- 208000014674 injury Diseases 0.000 description 2
- 238000007689 inspection Methods 0.000 description 2
- 239000000203 mixture Substances 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 239000000686 essence Substances 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000004321 preservation Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/12—Target-seeking control
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本申请提出一种无人机控制方法和装置。方法包括:无人机周期性地向操作员的遥控器中的GPS模块获取操作员的GPS位置信息;当获取到操作员的GPS位置信息时,无人机根据操作员的GPS位置信息与当前本无人机的GPS位置信息,计算本无人机与操作员之间的距离dc;当无人机根据dc发现当前本无人机位于预设安全敏感区域时,无人机根据dc与预设的无人机与操作员之间的最小安全距离ds,寻找能够最快到达的安全目标点,开始朝该安全目标点的方向飞行。本申请提高了无人机的飞行安全性。
Description
技术领域
本申请涉及无人机领域,尤其涉及一种无人机控制方法和装置。
背景技术
近十几年来,无人机已被广泛应用于航拍摄影、电力巡检、环境监测、森林防火、灾情巡查、防恐救生、军事侦察、战场评估等领域,有效克服了有人驾驶飞机空中作业的不足,降低了购买与维护成本,提高了运载工具的安全性。
无人机空中作业时,真实的飞行环境很难完全预知,面临着山脉、建筑物、树木、输电线路等有形障碍物的约束,以及禁飞区、危险区等无形障碍物的约束;需要注意的是,由于无人机空中作业时,还需要操作员手持遥控器对无人机的飞行进行控制,此时,操作员实际上也属于无人机的有形障碍物,为了保证操作员的安全,也为了避免损坏无人机,必须为无人机设计合理的飞行路线。
发明内容
本申请实施例提供无人机控制方法和装置,以提高无人机的飞行安全性。
本申请的技术方案是这样实现的:
一种无人机控制方法,该方法包括:
无人机周期性地向操作员的遥控器中的GPS模块获取操作员的GPS位置信息;
当获取到操作员的GPS位置信息时,无人机根据操作员的GPS位置信息与当前本无人机的GPS位置信息,计算本无人机与操作员之间的距离dc;
当无人机根据dc发现当前本无人机位于预设安全敏感区域时,无人机根据dc与预设的无人机与操作员之间的最小安全距离ds,寻找能够最快到达的安全目标点,开始朝该安全目标点的方向飞行。
一种无人机控制装置,位于无人机上,该装置包括:
GPS信息获取模块:周期性地向操作员的遥控器中的GPS模块获取操作员的GPS位置信息;
计算模块:根据GPS信息获取模块获取的操作员的GPS位置信息与当前本无人机的GPS位置信息,计算本无人机与操作员之间的距离dc;当根据dc发现当前本无人机位于预设安全敏感区域时,根据dc与预设的无人机与操作员之间的最小安全距离ds,寻找能够最快到达的安全目标点,开始朝该安全目标点的方向飞行。
可见,本申请实施例中,当无人机根据本无人机与操作员之间的距离发现自身位于预设安全敏感区域时,根据本无人机与操作员之间的距离以及预设的无人机与操作员之间的最小安全距离,寻找能够最快到达的安全目标点,开始朝该安全目标点的方向飞行,从而避免了对操作员的伤害,也避免了损坏本无人机,提高了飞行安全性。
附图说明
图1为本申请一实施例提供的无人机控制方法流程图;
图2为本申请另一实施例提供的无人机控制方法流程图;
图3为本申请应用示例提供的目标点的计算示意图;
图4为本申请实施例提供的无人机控制装置的组成示意图。
具体实施方式
下面结合附图及具体实施例对本发明再作进一步详细的说明。
图1为本申请一实施例提供的无人机控制方法流程图,其具体步骤如下:
步骤101:无人机周期性地向操作员的遥控器中的GPS(Global PositioningSystem,全球定位***)模块获取操作员的GPS位置信息。
步骤102:当获取到操作员的GPS位置信息时,无人机根据操作员的GPS位置信息与当前本无人机的GPS位置信息,计算本无人机与操作员之间的距离dc。
步骤103:当无人机根据dc发现当前本无人机位于预设安全敏感区域时,无人机根据dc与预设的无人机与操作员之间的最小安全距离ds,寻找能够最快到达的安全目标点,开始朝该安全目标点的方向飞行。
一实施例中,无人机根据dc发现当前本无人机位于预设安全敏感区域包括:
无人机判断ds<dc<2ds是否成立,若成立,则确认当前本无人机位于预设安全敏感区域,其中,ds为预设的无人机与操作员之间的最小安全距离。
一实施例中,无人机根据dc与预设的无人机与操作员之间的最小安全距离ds,寻找能够最快到达的安全目标点包括:
计算操作员到无人机的连线与操作员到安全目标点的连线之间的夹角θ:
θ=arccos(dc/2ds)
其中,arccos为反余弦变换运算符;
计算r=π/2–θ;
计算无人机到安全目标点的第一GPS分量dh:
dh=ds×cosr
其中,cos为余弦变换运算符;
计算无人机到安全目标点的第二GPS分量dv:
dv=dc/2;
根据操作员的GPS位置信息与dh、dv,计算安全目标点的位置信息。
一实施例中,遥控器位于移动终端上。
图2为本申请另一实施例提供的无人机控制方法流程图,其具体步骤如下:
步骤200:无人机保存管理员预先配置的无人机与操作员之间的最小安全距离值ds。
步骤201:无人机周期性地向操作员的遥控器的GPS模块查询操作员的GPS位置信息。
步骤202:当无人机查询到操作员的GPS位置信息时,根据操作员的GPS位置信息以及本无人机自带的GPS模块测量的当前本无人机的GPS位置信息,计算操作员与本无人机之间的距离dc。
步骤203:无人机判断ds<dc<2ds是否成立,若是,执行步骤204;否则,不作进一步处理。
步骤204:无人机计算操作员到无人机的连线与操作员到目标点的连线之间的夹角θ:
θ=arccos(dc/2ds)
其中,arccos为反余弦变换运算符;
步骤205:无人机计算r=π/2–θ。
步骤206:无人机计算本无人机到目标点的第一GPS分量dh:
dh=ds×cosr
其中,cos为余弦变换运算符;
同时,计算本无人机到目标点的第二GPS分量dv:
dv=dc/2。
步骤207:无人机根据操作员的GPS位置信息与dh、dv,计算目标点的位置信息。
如图3所示,某一时刻,无人机从操作员的遥控器查询到了操作员的GPS位置信息,该位置即为图3中的B点所在位置,此时,无人机所在位置为图3中的A点所在位置,无人机计算A、B之间的距离dc,若ds<dc<2ds,则:按照如下原则来寻找目标点D的位置:D点到A点的距离为最小安全距离,且从A点调整到D点所花费的时间最短,基于该原则,发明人想到D点应该通过如下方式确定:
分别以A点、B点为圆心,以ds为半径作两个圆,则该两个圆的两个交点中的任意一个都可作为D点,其中,D点的位置的计算过程如下:
设线段AB的中点为C,则连接C、D两点,则AB与BD的夹角θ为:
θ=arccos(BC/BD)=arccos((dc/2)/ds)
则r=π/2–θ;
BE=dh=BD×cosr=ds×cosr;
DE=dv=BD×sinr=ds×sinr=dc/2;
则根据B点的位置与dh、dv,可计算得到目标点D的位置,
若将两圆的另一交点D’作为目标点,D’的位置的计算过程与D的位置的计算过程相同。
步骤208:无人机根据计算出的目标点的位置信息,调整自身的飞行方向,向目标点方向飞行。
需要说明的是,在实际应用中,无人机会周期性地更新目标点D的位置信息,以调整飞行方向,更新周期为ms(毫秒)级,但是,操作员的遥控器的GPS模块向无人机反馈操作员的GPS位置信息的周期通常为s(秒)级,如:1s,这样,本申请中,当无人机与操作员之间的距离dc在2ds与ds之间时,虽然,无人机仍然是以毫秒级为周期来更新目标点D的位置信息,但是实质上,目标点D的位置信息是以秒级为周期发生真正改变的。
本申请实施例的有益技术效果如下:
本申请实施例中,当无人机根据本无人机与操作员之间的距离发现自身位于预设安全敏感区域时,根据本无人机与操作员之间的距离以及预设的无人机与操作员之间的最小安全距离,寻找能够最快到达的安全目标点,开始朝该安全目标点的方向飞行,从而尽可能地避免了对操作员的伤害,也避免了损坏本无人机,提高了飞行安全性。
图4为本申请一实施例提供的无人机控制装置的组成示意图,该装置位于无人机上,该装置主要包括:GPS信息获取模块和计算模块,其中:
GPS信息获取模块:周期性地向操作员的遥控器中的GPS模块获取操作员的GPS位置信息,将获取到的操作员的GPS位置信息发送给计算模块。
计算模块:根据GPS信息获取模块发来的操作员的GPS位置信息与从本无人机的GPS模块获取的当前本无人机的GPS位置信息,计算本无人机与操作员之间的距离dc;当根据dc发现当前本无人机位于预设安全敏感区域时,根据dc与预设的无人机与操作员之间的最小安全距离ds,寻找能够最快到达的安全目标点,开始朝该安全目标点的方向飞行。
一实施例中,计算模块根据dc发现当前本无人机位于预设安全敏感区域包括:
判断ds<dc<2ds是否成立,若成立,则确认当前本无人机位于预设安全敏感区域,其中,ds为预设的无人机与操作员之间的最小安全距离。
一实施例中,计算模块根据dc与预设的无人机与操作员之间的最小安全距离ds,寻找能够最快到达的安全目标点包括:
计算操作员到无人机的连线与操作员到安全目标点的连线之间的夹角θ:
θ=arccos(dc/2ds)
其中,arccos为反余弦变换运算符;
计算r=π/2–θ;
计算无人机到安全目标点的第一GPS分量dh:
dh=ds×cosr
其中,cos为余弦变换运算符;
计算无人机到安全目标点的第二GPS分量dv:
dv=dc/2;
根据操作员的GPS位置信息与dh、dv,计算安全目标点的位置信息。
以上所述仅为本申请的较佳实施例而已,并不用以限制本申请,凡在本申请的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本申请保护的范围之内。
Claims (7)
1.一种无人机控制方法,其特征在于,该方法包括:
无人机周期性地向操作员的遥控器中的全球定位***GPS模块获取操作员的GPS位置信息;
当获取到操作员的GPS位置信息时,无人机根据操作员的GPS位置信息与当前本无人机的GPS位置信息,计算本无人机与操作员之间的距离dc;
当无人机根据dc发现当前本无人机位于预设安全敏感区域时,无人机根据dc与预设的无人机与操作员之间的最小安全距离ds,寻找能够最快到达的安全目标点,开始朝该安全目标点的方向飞行;
所述无人机根据dc与预设的无人机与操作员之间的最小安全距离ds,寻找能够最快到达的安全目标点包括:
计算操作员到无人机的连线与操作员到安全目标点的连线之间的夹角θ;
根据夹角θ和预设的无人机与操作员之间的最小安全距离ds计算无人机到安全目标点的第一GPS分量dh;
根据距离dc计算无人机到安全目标点的第二GPS分量dv:
根据操作员的GPS位置信息与dh、dv,计算安全目标点的位置信息。
2.根据权利要求1所述的方法,其特征在于,所述无人机根据dc发现当前本无人机位于预设安全敏感区域包括:
无人机判断ds<dc<2ds是否成立,若成立,则确认当前本无人机位于预设安全敏感区域,
其中,ds为预设的无人机与操作员之间的最小安全距离。
3.根据权利要求1或2所述的方法,其特征在于,所述计算操作员到无人机的连线与操作员到安全目标点的连线之间的夹角θ包括:
θ=arccos(dc/2ds)
其中,arccos为反余弦变换运算符;
所述根据夹角θ和预设的无人机与操作员之间的最小安全距离ds计算无人机到安全目标点的第一GPS分量dh包括:
dh=ds×cosr
其中,r=π/2–θ,cos为余弦变换运算符;
所述计算无人机到安全目标点的第二GPS分量dv包括:
dv=dc/2。
4.根据权利要求3所述的方法,其特征在于,所述遥控器位于移动终端上。
5.一种无人机控制装置,位于无人机上,其特征在于,该装置包括:
全球定位***GPS信息获取模块:周期性地向操作员的遥控器中的GPS模块获取操作员的GPS位置信息;
计算模块:根据GPS信息获取模块获取的操作员的GPS位置信息与当前本无人机的GPS位置信息,计算本无人机与操作员之间的距离dc;当根据dc发现当前本无人机位于预设安全敏感区域时,根据dc与预设的无人机与操作员之间的最小安全距离ds,寻找能够最快到达的安全目标点,开始朝该安全目标点的方向飞行;
所述计算模块根据dc与预设的无人机与操作员之间的最小安全距离ds,寻找能够最快到达的安全目标点包括:
计算操作员到无人机的连线与操作员到安全目标点的连线之间的夹角θ;
根据夹角θ和预设的无人机与操作员之间的最小安全距离ds计算无人机到安全目标点的第一GPS分量dh;
根据距离dc计算无人机到安全目标点的第二GPS分量dv:
根据操作员的GPS位置信息与dh、dv,计算安全目标点的位置信息。
6.根据权利要求5所述的装置,其特征在于,所述计算模块根据dc发现当前本无人机位于预设安全敏感区域包括:
判断ds<dc<2ds是否成立,若成立,则确认当前本无人机位于预设安全敏感区域,
其中,ds为预设的无人机与操作员之间的最小安全距离。
7.根据权利要求5或6所述的装置,其特征在于,所述计算模块计算操作员到无人机的连线与操作员到安全目标点的连线之间的夹角θ包括:
θ=arccos(dc/2ds)
其中,arccos为反余弦变换运算符;
所述根据夹角θ和预设的无人机与操作员之间的最小安全距离ds计算无人机到安全目标点的第一GPS分量dh包括:
dh=ds×cosr
其中,r=π/2–θ,cos为余弦变换运算符;
所述计算无人机到安全目标点的第二GPS分量dv包括:
dv=dc/2。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610066533.9A CN105652890B (zh) | 2016-01-29 | 2016-01-29 | 一种无人机控制方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610066533.9A CN105652890B (zh) | 2016-01-29 | 2016-01-29 | 一种无人机控制方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105652890A CN105652890A (zh) | 2016-06-08 |
CN105652890B true CN105652890B (zh) | 2019-02-15 |
Family
ID=56488188
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610066533.9A Active CN105652890B (zh) | 2016-01-29 | 2016-01-29 | 一种无人机控制方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105652890B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106331684B (zh) * | 2016-08-30 | 2018-04-27 | 长江三峡勘测研究院有限公司(武汉) | 一种工程地质调查中基于小型无人机录像的三维影像获取方法 |
CN106959699A (zh) * | 2016-11-10 | 2017-07-18 | 宁波蓝飞鹂航空科技有限公司 | 一种基于操控者为基准点的一键自动返航模式的方法 |
CN107016840A (zh) * | 2016-11-10 | 2017-08-04 | 宁波蓝飞鹂航空科技有限公司 | 一种基于操控者为基准点的机头一键对准模式的方法 |
CN108922154A (zh) * | 2018-10-15 | 2018-11-30 | 无锡比特信息科技有限公司 | 无人机用遥控器 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102139164A (zh) * | 2011-01-28 | 2011-08-03 | 深圳市格兰之特科技有限公司 | 一种自动规避障碍物的飞行装置与方法 |
CN102854887A (zh) * | 2012-09-06 | 2013-01-02 | 北京工业大学 | 一种无人机航迹规划和远程同步操控方法 |
ES2409210T3 (es) * | 2008-11-12 | 2013-06-25 | Saab Ab | Dispositivo de estimación de distancia |
CN104133484A (zh) * | 2014-07-10 | 2014-11-05 | 浙江飞神车业有限公司 | 多旋翼飞行器电子控制装置、多旋翼飞行器的航拍电子控制装置及跟随航拍式多旋翼飞行器 |
CN104269078A (zh) * | 2014-09-23 | 2015-01-07 | 苏州天益航空科技有限公司 | 农用植保无人机碰撞检测方法 |
CN105116933A (zh) * | 2015-06-29 | 2015-12-02 | 厦门狄耐克物联智慧科技有限公司 | 一种无人飞行器及防止该无人飞行器脱离控制区域的方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4141860B2 (ja) * | 2003-02-26 | 2008-08-27 | 健蔵 野波 | 小型無人ヘリコプタの自律制御装置及びプログラム |
CN104516356B (zh) * | 2015-01-08 | 2017-07-14 | 西北工业大学 | 基于rrt的动态障碍规避算法 |
-
2016
- 2016-01-29 CN CN201610066533.9A patent/CN105652890B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
ES2409210T3 (es) * | 2008-11-12 | 2013-06-25 | Saab Ab | Dispositivo de estimación de distancia |
CN102139164A (zh) * | 2011-01-28 | 2011-08-03 | 深圳市格兰之特科技有限公司 | 一种自动规避障碍物的飞行装置与方法 |
CN102854887A (zh) * | 2012-09-06 | 2013-01-02 | 北京工业大学 | 一种无人机航迹规划和远程同步操控方法 |
CN104133484A (zh) * | 2014-07-10 | 2014-11-05 | 浙江飞神车业有限公司 | 多旋翼飞行器电子控制装置、多旋翼飞行器的航拍电子控制装置及跟随航拍式多旋翼飞行器 |
CN104269078A (zh) * | 2014-09-23 | 2015-01-07 | 苏州天益航空科技有限公司 | 农用植保无人机碰撞检测方法 |
CN105116933A (zh) * | 2015-06-29 | 2015-12-02 | 厦门狄耐克物联智慧科技有限公司 | 一种无人飞行器及防止该无人飞行器脱离控制区域的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105652890A (zh) | 2016-06-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11656638B1 (en) | Backup navigation system for unmanned aerial vehicles | |
CN105652890B (zh) | 一种无人机控制方法和装置 | |
US9847033B1 (en) | Communication of navigation data spoofing between unmanned vehicles | |
US9849978B1 (en) | Detecting of navigation data spoofing based on sensor data | |
US9646283B2 (en) | Secure payload deliveries via unmanned aerial vehicles | |
US9689686B1 (en) | Detecting of navigation data spoofing based on image data | |
US9569972B2 (en) | Unmanned aerial vehicle identity and capability verification | |
US9875454B2 (en) | Accommodating mobile destinations for unmanned aerial vehicles | |
CN105468024B (zh) | 一种无人机控制方法和装置 | |
US9725171B1 (en) | Analyzing navigation data to detect navigation data spoofing | |
US20160300495A1 (en) | Secure communications with unmanned aerial vehicles | |
CN108615412B (zh) | 用于无人驾驶飞行器的飞行计划分析***和方法 | |
EP3128386B1 (en) | Method and device for tracking a moving target from an air vehicle | |
US10991259B2 (en) | Drone remote piloting electronic system, associated method and computing program | |
US20190235489A1 (en) | System and method for autonomous remote drone control | |
WO2018103689A1 (zh) | 无人机相对方位控制方法及装置 | |
US10656643B1 (en) | Safe and secure practical autonomy | |
TW201931040A (zh) | 基於螺旋槳防護裝置的存在性來調整空中機器人式運載工具的飛行參數 | |
US20210264799A1 (en) | Uavs, including multi-processor uavs with secured parameters, and associated systems, devices, and methods | |
US20230289445A1 (en) | Tamper-resistant geo-fence system for drones | |
WO2019222868A1 (en) | Drone proximity charging | |
EP3343305B1 (en) | Systems and methods for establishing a flight pattern adjacent to a target for a vehicle to follow | |
CN116830057A (zh) | 无人机(uav)集群控制 | |
He et al. | How to govern the non-cooperative amateur drones? | |
KR20190048748A (ko) | 듀얼 gps를 이용한 자율 비행 시스템 및 방법 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |