CN103019250B - 巡检飞行机器人斜面起飞控制方法 - Google Patents
巡检飞行机器人斜面起飞控制方法 Download PDFInfo
- Publication number
- CN103019250B CN103019250B CN201210510268.0A CN201210510268A CN103019250B CN 103019250 B CN103019250 B CN 103019250B CN 201210510268 A CN201210510268 A CN 201210510268A CN 103019250 B CN103019250 B CN 103019250B
- Authority
- CN
- China
- Prior art keywords
- flying robot
- angle
- patrolling
- examining
- bevel
- 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
Landscapes
- Manipulator (AREA)
Abstract
本发明公开了飞行控制领域的一种巡检飞行机器人斜面起飞控制方法。其技术方案是,将斜面倾斜角度分为第一角度范围,第二角度范围和第三角度范围;并将巡检飞行机器人放在斜面上,并测量斜面角度值,确定斜面的角度范围;当测量斜面角度值属于第一角度范围和第二角度范围时,通过第一目标函数控制巡检飞行机器人姿态;当测量斜面角度值属于第三角度范围时,停止起飞;通过切换条件判断巡检飞行机器人是否转入悬停阶段;当满足切换条件,巡检飞行机器人转入悬停阶段,通过第二目标函数控制巡检飞行机器人姿态。本发明的有益效果是研究出了适合现场实际需求的斜面起飞方法,为巡检飞行机器人在实际环境中起飞奠定了基础。
Description
技术领域
本发明属于飞行控制领域,尤其涉及一种巡检飞行机器人斜面起飞控制方法。
背景技术
空中机器人的自主飞行控制是目前电力线巡检研究的一个重点方面,由于无人机巡检具有极高的安全性,灵活轻便,同时减少了人工巡检的花费,因此它是实现巡检例如架空电力线路巡检、输油管线巡检、交通监控等的重要途径。由于电力线路巡检多在野外进行,客观条件不容许飞机从理想平面上起飞。然而现有的模型都是基于平面起飞的,仅有少量的研究飞机斜面起飞问题。为了更好真实的重现飞机起飞过程,我们有必要引进飞机在斜面起飞时的三维模型。
针对实际遇到的客观问题这里引入了新型简单的控制算法。飞机在斜面上起飞时由于斜面有一定的倾角及高度,飞机过早的调整姿态可能导致飞机旋翼打到斜面上,造成很大的安全隐患。此外,鉴于野外环境的复杂性,该控制算法具有快速性,稳定性,节能性及良好的环境适应性,后两点主要体现在飞机飞行实际距离短,能够适应在狭小环境中起飞,能够更好的适应恶劣环境。
光流法是对运动序列图像进行分析的一个重要方法,光流不仅包含图像中目标的运动信息,而且包含了三维物理结构的丰富信息,因此可用来确定目标的运动情况以及反映图像其它等信息。光流传感器对于实时高精度的获取空中机器人的运动姿态和运动估计具有重要意义。
发明内容
针对背景技术中提到的电力线路巡检多在野外进行,客观条件不容许飞机从理想平面上起飞的问题,本发明提出了一种巡检飞行机器人斜面起飞控制方法。
一种巡检飞行机器人斜面起飞控制方法,其特征在于,具体步骤包括:
步骤1:将倾斜角度分为第一角度范围0-π/5,第二角度范围π/5-π/3和第三角度范围π/3-π/2;
步骤2:将巡检飞行机器人放在斜面上,并测量斜面角度值,确定斜面的角度范围;
步骤3:当测量斜面角度值属于第一角度范围和第二角度范围时,通过第一目标函数控制巡检飞行机器人姿态;当测量斜面角度值属于第三角度范围时,停止起飞;
步骤4:通过切换条件判断巡检飞行机器人是否转入悬停阶段;
步骤5:当满足切换条件,巡检飞行机器人转入悬停阶段,并通过第二目标函数控制巡检飞行机器人姿态;当不满足切换条件时,返回步骤4。所述第一目标函数为:
其中,τp,τr,τy分别巡检飞行机器人的俯仰,偏航和滚转角;T代表需要的升力,ω0为转子的速度;kpp表示倾斜角控制的比例单元系数;kdp代表倾斜角控制的微分单元系数;kpr、kpy和kpz分别表示偏航角、滚转角和升力控制的比例单元系数,kdr、kdy和kdz分别表示偏航角、滚转角和升力控制的积分单元系数;he是巡检飞行机器人起飞阶段高度的偏差;θe为巡检飞行机器人沿Y轴旋转的角度与Y轴设定值旋转角度的偏差值;αe为巡检飞行机器人沿X轴旋转的角度与X轴设定值旋转角度的偏差值;βe为巡检飞行机器人沿Z轴旋转的角度与Z轴设定值旋转角度的偏差值;和表示对θe、αe、βe和he求导;
所述切换条件为:
其中,θe为巡检飞行机器人沿Y轴旋转的角度与Y轴设定值旋转角度的偏差值;αe为巡检飞行机器人沿X轴旋转的角度与X轴设定值旋转角度的偏差值;βe为巡检飞行机器人沿Z轴旋转的角度与Z轴设定值旋转角度的偏差值;he为巡检飞行机器人起飞阶段高度的偏差,且he=h-z,h是起飞高度,且h=sinθcosθ(r+d),θ表示斜面倾斜角,d表示旋翼中心到巡检飞行机器人重心的距离,r表示巡检飞行机器人旋翼半径;z是巡检飞行机器人实时高度值;Δh为设定的高度增量。
所述第二目标函数为:
其中,T代表需要的升力;Ze是巡检飞行机器人高度的偏差;ω0为转子的速度;τp为巡检飞行机器人的俯仰角;kpp表示倾斜角控制的比例单元系数;kdp代表倾斜角控制的微分单元系数;kpz表示升力控制的比例单元系数;kdz表示控制的积分单元系数;θe为巡检飞行机器人沿Y轴旋转的角度与Y轴设定值旋转角度的偏差值;ze是巡检飞行机器人起飞阶段高度的偏差;和表示对θe和ze求导。
本发明的有益效果是,主要应用于空中机器人的自主飞行控制,并研究出了适合现场实际需求的斜面起飞算法,为空中机器人在实际环境中起飞奠定了基础,并且为以后实际中应用巡检飞行机器人进行电力线巡检做了理论方面的分析工作。
附图说明
图1巡检飞行机器人结构示意图;
图2是巡检飞行机器人起飞平面结构示意图;
图3是巡检飞行机器人第一阶段起飞切换至第二阶段悬停示意图;
图4是巡检飞行机器人起飞的斜面角度范围划分示意图;
图5是巡检飞行机器人斜面起飞控制方法流程图。
具体实施方式
下面结合附图,对优选实施例作详细说明。应该强调的是下述说明仅仅是示例性的,而不是为了限制本发明的范围及其应用。
图1巡检飞行机器人结构示意图。图1中,所示巡检飞行机器人上装有光流传感器,超声传感器、陀螺和加速计。其中光流传感器获得巡检飞行机器人水平运动的信息,超声传感器获得巡检飞行机器人实时高度信号大小,陀螺用于测量滚转角。
图2是巡检飞行机器人起飞平面结构示意图。图2中,xyz坐标系区分与机体坐标系,代表地面坐标系o{x,y,z};根据不同的斜面倾斜角度由于这里假定巡检飞行机器人运动方向,X方向代表巡检飞行机器人前进方向,Y代表巡检飞行机器人的侧向航程,Z轴垂直于地面,指示巡检飞行机器人飞行高度。
图3是巡检飞行机器人由第一阶段起飞切换至第二阶段悬停示意图。图3中,当巡检飞行机器人起飞之后满足切换条件时,就从起飞阶段转换至悬停阶段。
图4是巡检飞行机器人起飞的斜面角度范围划分示意图。图4中,第一阶段起飞根据不同的倾斜角度可分为第一角度范围(0-π/5),第二角度范围(π/5-π/3),第三角度范围(π/3-π/2)。第一角度范围(0-π/5)决定巡检飞行机器人可以保持倾斜角θ不变,换而言之可以保持在起飞的飞行姿态;当巡检飞行机器人起飞角度处于第二角度范围(π/5-π/3)时,巡检飞行机器人在起飞时保持倾斜角不变,其目的是为了防止巡检飞行机器人的机翼撞击到起飞倾斜面上,飞行一段时间后调整巡检飞行机器人姿态至第一角度范围;当巡检飞行机器人起飞角度第三角度范围(π/3-π/2)中,由于倾斜角度过大,不宜起飞。
在本实施例中,倾斜角初值设定为π/3,设定角度为π/5。当转换条件满足的时候,巡检飞行机器人飞行姿态角度从π/3转到π/5,经过一段时间的调整后由π/5调整到0。这里的0代表的是巡检飞行机器人处于悬停模式。
图5是巡检飞行机器人斜面起飞控制方法流程图。图5中,具体步骤包括:
步骤1:将倾斜角度分为第一角度范围0-π/5,第二角度范围π/5-π/3和第三角度范围π/3-π/2;
步骤2:将巡检飞行机器人放在斜面上,并测量斜面角度值,确定斜面的角度范围;
步骤3:当测量斜面角度值属于第一角度范围和第二角度范围时,通过第一目标函数控制巡检飞行机器人姿态;当测量斜面角度值属于第三角度范围时,停止起飞;
步骤4:通过切换条件判断巡检飞行机器人是否转入悬停阶段;
步骤5:当满足切换条件,巡检飞行机器人转入悬停阶段,并通过第二目标函数控制巡检飞行机器人姿态;当不满足切换条件时,返回步骤4。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求的保护范围为准。
Claims (1)
1.一种巡检飞行机器人斜面起飞控制方法,其特征在于,具体步骤包括:
步骤1:将倾斜角度分为第一角度范围0-π/5,第二角度范围π/5-π/3和第三角度范围π/3-π/2;
步骤2:将巡检飞行机器人放在斜面上,并测量斜面角度值,确定斜面的角度范围;
步骤3:当测量斜面角度值属于第一角度范围和第二角度范围时,通过第一目标函数控制巡检飞行机器人姿态;当测量斜面角度值属于第三角度范围时,停止起飞;
所述第一目标函数为:
其中,τp,τr,τy分别巡检飞行机器人的俯仰,偏航和滚转角;T代表需要的升力,ω0为转子的速度;kpp表示倾斜角控制的比例单元系数;kdp代表倾斜角控制的微分单元系数;kpr、kpy和kpz分别表示偏航角、滚转角和升力控制的比例单元系数,kdr、kdy和kdz分别表示偏航角、滚转角和升力控制的积分单元系数;he是巡检飞行机器人起飞阶段高度的偏差;θe为巡检飞行机器人沿Y轴旋转的角度与Y轴设定值旋转角度的偏差值;αe为巡检飞行机器人沿X轴旋转的角度与X轴设定值旋转角度的偏差值;βe为巡检飞行机器人沿Z轴旋转的角度与Z轴设定值旋转角度的偏差值;和表示对θe、αe、βe和he求导;
步骤4:通过切换条件判断巡检飞行机器人是否转入悬停阶段;
所述切换条件为:
其中,he=h-z,h是起飞高度,且h=sinθcosθ(r+d),θ表示斜面倾斜角,d表示旋翼中心到巡检飞行机器人重心的距离,r表示巡检飞行机器人旋翼半径;z是巡检飞行机器人实时高度值;Δh为设定的高度增量;
步骤5:当满足切换条件,巡检飞行机器人转入悬停阶段,并通过第二目标函数控制巡检飞行机器人姿态;当不满足切换条件时,返回步骤4;
所述第二目标函数为:
其中,Ze是巡检飞行机器人高度的偏差,表示对Ze求导。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210510268.0A CN103019250B (zh) | 2012-12-03 | 2012-12-03 | 巡检飞行机器人斜面起飞控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210510268.0A CN103019250B (zh) | 2012-12-03 | 2012-12-03 | 巡检飞行机器人斜面起飞控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103019250A CN103019250A (zh) | 2013-04-03 |
CN103019250B true CN103019250B (zh) | 2015-01-07 |
Family
ID=47967957
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210510268.0A Expired - Fee Related CN103019250B (zh) | 2012-12-03 | 2012-12-03 | 巡检飞行机器人斜面起飞控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103019250B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106200681B (zh) * | 2014-03-27 | 2020-03-06 | 深圳市大疆创新科技有限公司 | 可移动物体的起飞辅助的方法以及*** |
CN105005342B (zh) * | 2015-08-11 | 2017-06-16 | 中国航空工业集团公司西安飞机设计研究所 | 控制飞行器自动起飞的方法 |
CN108450032B (zh) * | 2016-12-22 | 2021-03-02 | 深圳市大疆创新科技有限公司 | 飞行控制方法和装置 |
CN107703971B (zh) * | 2017-11-20 | 2023-08-25 | 唐菲菲 | 巡查区域的无人机调动方法及*** |
CN107977021A (zh) * | 2017-11-28 | 2018-05-01 | 佛山市安尔康姆航空科技有限公司 | 一种云台舵机的控制方法 |
CN108780330A (zh) * | 2017-12-14 | 2018-11-09 | 深圳市大疆创新科技有限公司 | 飞行器安全起飞方法、降落方法及飞行器 |
JP6777355B2 (ja) * | 2018-06-04 | 2020-10-28 | 株式会社ナイルワークス | ドローンシステム、ドローンシステムの制御方法、およびドローンシステムの制御プログラム |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101940845A (zh) * | 2010-07-23 | 2011-01-12 | 燕高飞 | 蛋壳型外框架 |
CN102117072A (zh) * | 2011-03-10 | 2011-07-06 | 上海交通大学 | 具有旋翼转速检测功能的多旋翼飞行器地面测控*** |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006082774A (ja) * | 2004-09-17 | 2006-03-30 | Hiroboo Kk | 無人飛行体及び無人飛行体制御方法 |
JP5392891B2 (ja) * | 2008-09-05 | 2014-01-22 | 学校法人東京電機大学 | 飛翔ロボット |
-
2012
- 2012-12-03 CN CN201210510268.0A patent/CN103019250B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101940845A (zh) * | 2010-07-23 | 2011-01-12 | 燕高飞 | 蛋壳型外框架 |
CN102117072A (zh) * | 2011-03-10 | 2011-07-06 | 上海交通大学 | 具有旋翼转速检测功能的多旋翼飞行器地面测控*** |
Non-Patent Citations (2)
Title |
---|
JP特开2006-82774A 2006.03.30 * |
JP特开2010-58779A 2010.03.18 * |
Also Published As
Publication number | Publication date |
---|---|
CN103019250A (zh) | 2013-04-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103019250B (zh) | 巡检飞行机器人斜面起飞控制方法 | |
CN108306217B (zh) | 一种架空高压线智能自主沿导线飞行巡检***和方法 | |
Mirallès et al. | LineDrone Technology: Landing an unmanned aerial vehicle on a power line | |
Laiacker et al. | Vision aided automatic landing system for fixed wing UAV | |
CN104843176B (zh) | 一种用于桥梁隧道自动巡检旋翼无人机***及导航方法 | |
CN103224026B (zh) | 一种适用于山区电网巡检的专用无人直升机避障***及其工作流程 | |
Kim et al. | Accurate modeling and robust hovering control for a quad-rotor VTOL aircraft | |
CN103853156B (zh) | 一种基于机载传感器的小型四旋翼飞行器控制***及方法 | |
JP6179502B2 (ja) | マルチコプタを用いた3次元形状計測方法および装置 | |
Schäfer et al. | Multicopter unmanned aerial vehicle for automated inspection of wind turbines | |
CN103606852B (zh) | 无人直升机的电力线巡检方法 | |
CN203397214U (zh) | 一种适用于山区电网巡检的专用无人直升机避障*** | |
CN203038112U (zh) | 无人机uav自动控制*** | |
CN104298248A (zh) | 旋翼无人机精确视觉定位定向方法 | |
CN104460685A (zh) | 一种四旋翼飞行器的控制***及其控制方法 | |
CN109709986A (zh) | 一种无人机控制***及方法 | |
CN203825466U (zh) | 一种基于机载传感器的小型四旋翼飞行器控制*** | |
CN204871599U (zh) | 四轴飞行器 | |
CN112748744A (zh) | 变电站两栖巡检装置及其巡检方法 | |
CN105629995A (zh) | 一种系留跟随***和方法 | |
CN1669874A (zh) | 一种用于飞行器的自动驾驶仪 | |
CN104875882A (zh) | 四轴飞行器 | |
CN205121348U (zh) | 无人飞行器安全快速降落***及其遥控设备和无人飞行器 | |
CN103869811B (zh) | 一种四旋翼飞行器的遥控和伺服信号的监控方法 | |
CN106802662A (zh) | 一种多旋翼无人机嵌入式控制*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150107 Termination date: 20151203 |
|
EXPY | Termination of patent right or utility model |