CN107346140B - 一种无头控制的方法 - Google Patents
一种无头控制的方法 Download PDFInfo
- Publication number
- CN107346140B CN107346140B CN201610297215.3A CN201610297215A CN107346140B CN 107346140 B CN107346140 B CN 107346140B CN 201610297215 A CN201610297215 A CN 201610297215A CN 107346140 B CN107346140 B CN 107346140B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- remote controller
- headless
- control
- 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 17
- 239000011159 matrix material Substances 0.000 claims abstract description 16
- 101100182248 Caenorhabditis elegans lat-2 gene Proteins 0.000 claims description 19
- 101100182247 Caenorhabditis elegans lat-1 gene Proteins 0.000 claims description 13
- 101150061388 LON1 gene Proteins 0.000 claims description 7
- 101150004293 lon2 gene Proteins 0.000 claims description 7
- 210000003128 head Anatomy 0.000 description 4
- 208000027418 Wounds and injury Diseases 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000006378 damage Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 208000037265 diseases, disorders, signs and symptoms Diseases 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 208000014674 injury Diseases 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
- 230000003068 static effect Effects 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
Images
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/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
-
- 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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种无头控制的方法,无头控制的方法包括:S1,接收到无头控制命令或起飞命令;S2,实时计算遥控器指向无人机的航向角theta;S3,根据航向角theta得出旋转矩阵DCM;S4,将接收到的初始控制量V与旋转矩阵DCM结合得出无人机的无头姿态控制量C;S5,无人机根据无头姿态控制量C调整飞行姿态。这样,当用户触发无头控制键,或者触发起飞按键通过遥控器控制无人机起飞时,用户利用遥控器控制无人机飞行,无论无人机的机头处于哪个方向,无人机都会以用户的方位进行飞行,并且由于***在实时计算遥控器指向无人机的航向角,用户利用遥控器控制无人机向左或右飞行时,无人机就会以用户为中心以无人机到用户的距离为半径盘旋飞行。
Description
技术领域
本发明涉及无人机技术领域,具体涉及是一种无头控制的方法。
背景技术
目前,无人驾驶飞机简称“无人机”,是利用无线电遥控设备和自备的程序控制装置操纵的不载人飞机,目前大量应用在航拍、地貌的测量、运输等行业。
无人机在使用中具有成本低、使用方便、环境适应性强等特点,所以正逐步走进人们的普通生活,广受大家的喜爱与应用,一般的无人机都有机头,当无人机飞行的距离比较近时,用户可以用眼睛看见无人机的机头,然而一旦无人机飞行的距离比较远或无人机的飞行距离超出人的视线范围时,用户无法用眼睛辨别无人机机头的方向,就不能很好的控制无人机的飞行,无人机就会乱飞,这样会存在很大的安全隐患。
因此,需要一种新的技术方案,能够在用户利用遥控器控制无人机飞行时,无论无人机的机头处于哪个方向,无人机都会以用户的方位进行飞行。
有鉴于此特提出本发明。
发明内容
本发明要解决的技术问题在于克服现有技术的不足,提供一种当用户触发无头控制键时,在用户利用遥控器控制无人机飞行时,无论无人机的机头处于哪个方向,无人机都会以用户的方位进行飞行的无头控制的方法。
为解决上述技术问题,本发明采用技术方案的基本构思是:
本发明提出了一种无头控制的方法,所述无头控制的方法包括:
S1,遥控器接收到无头控制命令或起飞命令;
S2,遥控器实时计算遥控器指向无人机的航向角theta;
S3,根据航向角theta得出旋转矩阵DCM;
S4,将遥控器接收到的用户输入的初始控制量V与所述旋转矩阵DCM结合得出无人机的无头姿态控制量C;
S5,遥控器将无头姿态控制量C发送至无人机,以供无人机根据所述无头姿态控制量C调整飞行姿态。
优选地,在所述步骤S1与S2之间还包括:
Sa,根据遥控器与无人机的实时距离S是否在危险距离范围内,来确定无人机的飞行状态。
优选地,所述步骤Sa具体包括:
Sa1,遥控器实时计算遥控器与无人机的实时距离S;
Sa2,当所述实时距离S大于危险距离时,无人机正常飞行,当所述实时距离S小于或等于危险距离时,无人机悬停。
优选地,所述步骤Sa1具体包括:
实时获取遥控器的纬度lat1和经度lon1,以及无人机的纬度lat2和经度lon2;
计算遥控器和无人机的纬度差θ=lat1-lat2,和经度差b=lon1-lon2;
根据lat1、lon1、lat2、lon2、θ、b和earth_radius计算遥控器与无人机的实时距离S,其中,earth_radius是地球半径。
优选地,所述实时距离S为:
优选地,所述航向角theta为:
theta=arctan2f(sin(b)*cos(lat2),cos(lat1)*cos(lat2)*sin(lat2)-sin(lat1)*cos(lat2)*cos(b))。
优选地,所述旋转矩阵DCM为:
其中,pitch=0,roll=0,yaw=theta。
优选地,所述步骤S4具体包括:
遥控器接收用户输入的初始控制量V;
计算无人机的无头姿态控制量C为:
C=DCM*V。
优选地,所述初始控制量V为:
其中,Vpitch是遥控器接收的无人机前后移动的控制量,Vroll是遥控器接收的无人机横向移动的控制量,Vthrust是遥控器接收的无人机上下移动的控制量。
优选地,所述无人机的无头姿态控制量C为:
其中,Cpitch是无头控制下的无人机前后移动的姿态控制量,Croll是无头控制下的无人机横向移动的姿态控制量,Cthrust是无头控制下的无人机上下移动的姿态控制量。
采用上述技术方案后,本发明与现有技术相比具有以下有益效果。
通过上述技术方案,当用户触发无头控制键时,在用户利用遥控器控制无人机飞行时,无论无人机的机头处于哪个方向,无人机都会以用户的方位进行飞行,并且由于***在实时计算遥控器指向无人机的航向角,用户利用遥控器控制无人机向左或右飞行时,无人机就会以用户为中心以无人机到用户的距离为半径盘旋飞行。
或者,当用户触发遥控器上的起飞按键,遥控器就会接收到起飞命令,然后,无人机就会以用户的方位进行飞行,这样,只要用户发起起飞控制,无论无人机的机头处于哪个方向,就可以从开始起飞直接进入无头控制模式,方便用户的使用。
附图说明
为了更清楚的说明本发明具体实施方式中的技术方案,下面将对具体实施方式中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1示出了本发明的一个实施例的无头控制的方法的流程图;
图2示出了本发明的一个实施例的步骤Sa展开的流程图。
具体实施方式
下面结合附图对本发明的具体实施方式作进一步详细的描述。
如图1所示,一种无头控制的方法,所述无头控制的方法包括:
S1,遥控器接收到无头控制命令;
S2,遥控器实时计算遥控器指向无人机的航向角theta;
S3,根据航向角theta得出旋转矩阵DCM;
S4,将遥控器接收到的用户输入的初始控制量V与所述旋转矩阵DCM结合得出无人机的无头姿态控制量C;
S5,遥控器将无头姿态控制量C发送至无人机,以供无人机根据所述无头姿态控制量C调整飞行姿态。
在上述技术方案中,在无人机的遥控器上设有无头控制键,当用户按下无头控制键时,***就会计算该遥控器指向无人机的航向角theta,这样就知道了无人机相对于遥控器(即无人机相对于人)的方向,然后再利用该航向角theta确定出旋转矩阵DCM,这样,当用户向遥控器输入初始控制量V时,就可以将旋转矩阵DCM赋予到初始控制量V上,就可以得出控制无人机的无头姿态控制量C,无人机就可以根据该无头姿态控制量C进行飞行,这样无论无人机的机头处于哪个方向,经过上述方案后无人机都会按照遥控器(即人)的方位进行飞行。
或者,当用户触发遥控器上的起飞按键,遥控器就会接收到起飞命令,然后,无人机就会以用户的方位进行飞行,这样,只要用户发起起飞控制,无论无人机的机头处于哪个方向,就可以从开始起飞直接进入无头控制模式,方便用户的使用。
其中由于***在实时计算遥控器指向无人机的航向角theta,所以用户利用遥控器控制无人机向左或右飞行时,无人机就会以用户为中心以无人机到用户的距离为半径盘旋飞行。
例如,当用户在利用遥控器控制飞机飞行时,用户按下遥控器上的无头控制键,然后用户利用遥控器控制飞机向前飞行,这样无论飞机的机头在哪,都会向人的前方飞行,利用遥控器控制飞机向后飞行,飞机就会向人靠近,当用户利用遥控器控制飞机向左或右飞行,这样飞机就会以用户为中心顺时针或逆时针盘旋飞行。
通过上述技术方案,当用户触发无头控制键,或者触发起飞按键通过遥控器控制无人机起飞时,用户利用遥控器控制无人机飞行,无论无人机的机头处于哪个方向,无人机都会以用户的方位进行飞行,并且由于***在实时计算遥控器指向无人机的航向角,用户利用遥控器控制无人机向左或右飞行时,无人机就会以用户为中心以无人机到用户的距离为半径盘旋飞行。
优选地,在所述步骤S1与S2之间还包括:
Sa,根据遥控器与无人机的实时距离S是否在危险距离范围内,来确定无人机的飞行状态。
如图2所示,所述步骤Sa具体包括:
Sa1,遥控器实时计算遥控器与无人机的实时距离S;
Sa2,当所述实时距离S大于危险距离时,无人机正常飞行,当所述实时距离S小于或等于危险距离时,无人机悬停。
在上述技术方案中,为了保证用户的安全,防止无人机出现故障掉落时伤害到用户,需要为无人机的飞行设置危险距离,这样当用户触发无头控制键后,***就会实时计算遥控器与无人机的实时距离S,当计算得出的实时距离S小于或等于危险距离(即,在危险距离范围内),就会控制无人机静止悬停在空中,这样无人机不会飞到用户的头顶排除安全隐患,同时,确保在进行无头模式飞行时,确保无人机前后运动时都沿着指向用户位置的半径方向运动。
通过上述技术方案,保证了用户的人身安全,提高了无人机的安全系数。
优选地,所述步骤Sa1具体包括:
实时获取遥控器的纬度lat1和经度lon1,以及无人机的纬度lat2和经度lon2;
计算遥控器和无人机的纬度差θ=lat1-lat2,和经度差b=lon1-lon2;
根据lat1、lon1、lat2、lon2、θ、b和earth_radius计算遥控器与无人机的实时距离S,其中,earth_radius是地球半径。
优选地,所述实时距离S为:
在上述技术方案中,当用户触发无头控制键时,利用GPS获取遥控器的经纬度lon1和lat1,和无人机的经纬度lon2和lat2,然后计算遥控器和无人机的纬度差θ=lat1-lat2和经度差b=lon1-lon2,这样就可以计算实时距离S了。
优选地,所述航向角theta为:
theta=arctan2f(sin(b)*cos(lat2),cos(lat1)*cos(lat2)*sin(lat2)-sin(lat1)*cos(lat2)*cos(b))。
优选地,所述旋转矩阵DCM为:
其中,pitch=0,roll=0,yaw=theta。
在上述技术方案中,根据pitch、roll和yaw计算并得出旋转矩阵DCM,并且将pitch=0,roll=0,yaw=theta赋予到旋转矩阵DCM中,这时,当用户向遥控器输入初始控制量V时,就可以将旋转矩阵DCM赋予到初始控制量V上,得出控制无人机的无头姿态控制量C,无人机就可以根据该无头姿态控制量C进行飞行,这样无论无人机的机头处于哪个方向,经过上述方案后无人机都会按照遥控器(即人)的方位进行飞行,因此,此时就可以认为无人机的机头方向已经改变了,机头变成人的前方方向,这样有利于用户利用遥控器直接控制无人机的飞行。
优选地,所述步骤S4具体包括:
遥控器接收用户输入的初始控制量V;
计算无人机的无头姿态控制量C为:
C=DCM*V。
优选地,所述初始控制量V为:
其中,Vpitch是遥控器接收的无人机前后移动的控制量,Vroll是遥控器接收的无人机横向移动的控制量,Vthrust是遥控器接收的无人机上下移动的控制量。
优选地,所述无人机的无头姿态控制量C为:
其中,Cpitch是无头控制下的无人机前后移动的姿态控制量,Croll是无头控制下的无人机横向移动的姿态控制量,Cthrust是无头控制下的无人机上下移动的姿态控制量。
在上述技术方案中,当接收到用户利用遥控器发出的控制信号后,将控制信号转换成相应的初始控制量V,然后将旋转矩阵DCM与该初始控制量V做乘运算后得出能够控制无人机飞行的无头姿态控制量C,无人机就可以按照该无头姿态控制量C来调整飞行姿态,就可以以用户的方位进行飞行了。
通过本发明的技术方案,当用户触发无头控制键时,在用户利用遥控器控制无人机飞行时,无论无人机的机头处于哪个方向,无人机都会以用户的方位进行飞行,并且由于***在实时计算遥控器指向无人机的航向角用户利用遥控器控制无人机向左或右飞行时,无人机就会以用户为中心以无人机到用户的距离为半径盘旋飞行。
或者,当用户触发遥控器上的起飞按键,遥控器就会接收到起飞命令,然后,无人机就会以用户的方位进行飞行,这样,只要用户发起起飞控制,无论无人机的机头处于哪个方向,就可以从开始起飞直接进入无头控制模式,方便用户的使用。
上述实施例中的实施方案可以进一步组合或者替换,且实施例仅仅是对本发明的优选实施例进行描述,并非对本发明的构思和范围进行限定,在不脱离本发明设计思想的前提下,本领域中专业技术人员对本发明的技术方案做出的各种变化和改进,均属于本发明的保护范围。
Claims (9)
1.一种无头控制的方法,其特征在于,包括以下步骤:
S1,遥控器接收到无头控制命令或起飞命令;
S2,遥控器实时计算遥控器指向无人机的航向角theta;
实时获取遥控器的纬度lat1和经度lon1,以及无人机的纬度lat2和经度lon2;
计算遥控器和无人机的纬度差θ=lat1-lat2,和经度差b=lon1-lon2;
theta=arctan2f(sin(b)*cos(lat2),cos(lat1)*cos(lat2)*sin(lat2)-sin(lat1)*cos(lat2)*cos(b))S3,根据航向角theta得出旋转矩阵DCM;
S4,将遥控器接收到的用户输入的初始控制量V与所述旋转矩阵DCM结合得出无人机的无头姿态控制量C;
S5,遥控器将无头姿态控制量C发送至无人机,以供无人机根据所述无头姿态控制量C调整飞行姿态。
2.根据权利要求1所述的无头控制的方法,其特征在于,在所述步骤S1与S2之间还包括:
Sa,根据遥控器与无人机的实时距离S是否在危险距离范围内,来确定无人机的飞行状态。
3.根据权利要求2所述的无头控制的方法,其特征在于,所述步骤Sa具体包括:
Sa1,遥控器实时计算遥控器与无人机的实时距离S;
Sa2,当所述实时距离S大于危险距离时,无人机正常飞行,当所述实时距离S小于或等于危险距离时,无人机悬停。
4.根据权利要求3所述的无头控制的方法,其特征在于,所述步骤Sa1具体包括:
根据lat1、lon1、lat2、lon2、θ、b和earth_radius计算遥控器与无人机的实时距离S,其中,earth_radius是地球半径。
7.根据权利要求1-6任一项所述的无头控制的方法,其特征在于,所述步骤S4具体包括:
遥控器接收用户输入的初始控制量V;
计算无人机的无头姿态控制量C为:
C=DCM*V。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610297215.3A CN107346140B (zh) | 2016-05-06 | 2016-05-06 | 一种无头控制的方法 |
PCT/CN2016/086473 WO2017113648A1 (zh) | 2015-12-31 | 2016-06-20 | 体感遥控器、体感遥控飞行***和方法、无头控制方法 |
EP16880456.5A EP3399380B1 (en) | 2015-12-31 | 2016-06-20 | Headless control method |
US16/067,557 US11327477B2 (en) | 2015-12-31 | 2016-06-20 | Somatosensory remote controller, somatosensory remote control flight system and method, and head-less control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610297215.3A CN107346140B (zh) | 2016-05-06 | 2016-05-06 | 一种无头控制的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107346140A CN107346140A (zh) | 2017-11-14 |
CN107346140B true CN107346140B (zh) | 2020-04-07 |
Family
ID=60253866
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610297215.3A Active CN107346140B (zh) | 2015-12-31 | 2016-05-06 | 一种无头控制的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107346140B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107203216A (zh) * | 2017-06-06 | 2017-09-26 | 广州市海葱科技有限公司 | 一种无人机飞行控制方法、***、电子设备及存储介质 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101598556B (zh) * | 2009-07-15 | 2011-05-04 | 北京航空航天大学 | 一种未知环境下无人机视觉/惯性组合导航方法 |
EP2486728A4 (en) * | 2009-10-05 | 2015-10-21 | Lumexis Corp | IN-CAR RADIO COMMUNICATION SYSTEM |
WO2014187027A1 (zh) * | 2013-05-22 | 2014-11-27 | 上海九鹰电子科技有限公司 | 遥控信号的发送装置和方法、以及接收装置和方法 |
CN103712598B (zh) * | 2013-12-31 | 2014-12-17 | 渤海大学 | 一种小型无人机姿态确定方法 |
CN104298248B (zh) * | 2014-10-08 | 2018-02-13 | 南京航空航天大学 | 旋翼无人机精确视觉定位定向方法 |
CN104536453B (zh) * | 2014-11-28 | 2017-08-04 | 深圳一电航空技术有限公司 | 飞行器的控制方法及装置 |
CN104714556B (zh) * | 2015-03-26 | 2017-08-11 | 清华大学 | 无人机智能航向控制方法 |
CN105223959B (zh) * | 2015-09-28 | 2018-07-13 | 佛山市南海区广工大数控装备协同创新研究院 | 一种无人机手套控制***及控制方法 |
CN105469579B (zh) * | 2015-12-31 | 2020-05-29 | 北京臻迪机器人有限公司 | 体感遥控器、体感遥控飞行***和方法 |
CN105549608A (zh) * | 2016-02-29 | 2016-05-04 | 深圳飞豹航天航空科技有限公司 | 一种无人机方位调整方法及其*** |
-
2016
- 2016-05-06 CN CN201610297215.3A patent/CN107346140B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN107346140A (zh) | 2017-11-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3500903B1 (en) | Systems and methods of unmanned aerial vehicle flight restriction for stationary and moving objects | |
CN107850894B (zh) | 用于控制无人驾驶自主式***的方法和装置 | |
CN108292136B (zh) | 利用或避免飞行器的空气阻力 | |
EP2673681B1 (en) | Flight control laws for constant vector flat turns | |
CN106662870B (zh) | 用于生成飞行器的结果设定点轨迹的方法及设备、相关飞行器 | |
US20090105890A1 (en) | Automated Safe Flight Vehicle | |
US20130060405A1 (en) | Flight control support device | |
EP3399380B1 (en) | Headless control method | |
US20170357255A1 (en) | Method for controlling unmanned aerial vehicle using smart device | |
CN107102646B (zh) | 防止飞行器尾部接触地面的***和方法 | |
CN111045450B (zh) | 固定翼无人机双机编队组队过程制导方法 | |
CN108382575B (zh) | 旋翼飞行器电传飞行复飞模式 | |
WO2016150987A1 (en) | Path-based flight maneuvering system | |
CN109383781B (zh) | 用于旋翼飞行器接近悬停的***和方法 | |
Cacan et al. | Human-in-the-loop control of guided airdrop systems | |
US10132932B1 (en) | Geo-fencing systems and methods for aerial vehicles | |
CN107346140B (zh) | 一种无头控制的方法 | |
WO2022047709A1 (zh) | 更新限制区域数据的方法、装置、可移动平台和计算机存储介质 | |
CN106774368B (zh) | 飞行器操控和遥控方法、飞行器、遥控设备及飞行器*** | |
KR101506805B1 (ko) | 터치패널을 이용한 회전익 항공기 자동조종장치 및 자동조종방법 | |
Stevenson et al. | Assessment of alternative manual control methods for small unmanned aerial vehicles | |
Fricke et al. | Strategies for manual landing of remotely piloted airplanes with large time delay | |
Driscoll | The Effect of a Light Aircraft Stability Augmentation System on Pilot Performance | |
Kumar et al. | First pilot view (FPV) flying UAV test bed for acoustic and image data generation | |
Yakimenko | Autonomous Parachute-Based Precision Delivery Systems |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | 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 |