CN108571969B - 基于pwm波占空比的多旋翼飞行器导航方法 - Google Patents
基于pwm波占空比的多旋翼飞行器导航方法 Download PDFInfo
- Publication number
- CN108571969B CN108571969B CN201810374436.5A CN201810374436A CN108571969B CN 108571969 B CN108571969 B CN 108571969B CN 201810374436 A CN201810374436 A CN 201810374436A CN 108571969 B CN108571969 B CN 108571969B
- Authority
- CN
- China
- Prior art keywords
- rotor
- duty ratio
- aircraft
- pwm wave
- wave duty
- 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 20
- 238000012360 testing method Methods 0.000 claims abstract description 9
- 238000012545 processing Methods 0.000 claims abstract description 4
- 230000001133 acceleration Effects 0.000 claims description 6
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 230000001419 dependent effect Effects 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 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
- 238000005259 measurement Methods 0.000 description 1
Images
Classifications
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于PWM波占空比的多旋翼飞行器导航方法,包括以下步骤:S1、通过旋翼台架试验,测试PWM波占空比和旋翼转速、升力、力矩数据,通过数据处理,得到PWM波占空比与旋翼转速、升力、力矩的关系。S2、根据步骤1中PWM波占空比与旋翼转速、升力、力矩的关系,建立多旋翼飞行器动力学方程。S3、根据实际PWM波占空比,解算动力学方程,得到导航信息。本发明所述的基于PWM波占空比的多旋翼飞行器导航方法,通过PWM波占空比,解算多旋翼无人机的动力学方程,获得导航信息。通过该方法实现多旋翼飞行器的自主导航功能。无需外源导航信息和额外硬件设备;原理简单,易于实现;成本低。
Description
技术领域
本发明涉及飞行器设计技术领域,具体地说是一种基于PWM波占空比的多旋翼飞行器导航方法。
背景技术
目前,随着技术的发展,多旋翼飞行器的应用越来越广泛。
多旋翼飞行器在飞行过程中需要导航***提供导航信息。目前通常使用卫星导航***(GPS、北斗等)和惯性导航***等提供导航信息。
卫星导航***对外源信息的依赖十分严重,并且容易受到天气和地形障碍的干扰,极大地限制了多旋翼飞行器的应用场景。惯性导航需要额外惯性原件进行惯性测量,会增加飞行器重量,不利于旋翼飞行器的轻量化。
发明内容
根据上述提出的技术问题,而提供一种基于PWM波占空比的多旋翼飞行器导航方法,用于解决现有的卫星导航***对外源信息的依赖十分严重,并且容易受到天气和地形障碍的干扰,极大地限制了多旋翼飞行器的应用场景的缺点。本发明采用的技术手段如下:
一种基于PWM波占空比的多旋翼飞行器导航方法,包括以下步骤:
S1、通过旋翼台架试验,测试PWM波占空比和旋翼转速、升力、力矩数据,通过数据处理,得到PWM波占空比与旋翼转速、升力、力矩的关系。
S2、根据步骤1中PWM波占空比与旋翼转速、升力、力矩的关系,建立多旋翼飞行器动力学方程。
S3、根据实际PWM波占空比,解算动力学方程,得到导航信息。
作为优选步骤S1中,具体的,单个旋翼产生的升力、力矩分别表示为:
Fi=f(ωi) (1)
Mi=h(ωi) (2)
式中,ωi表示第i个旋翼的PWM波占空比,Fi表示第i个旋翼产生的升力,Mi表示第i个旋翼产生的力矩;
旋翼转速Ω表示为
Ωi=k(ωi) (3)。
作为优选步骤S2中,建立多旋翼飞行器动力学方程的具体步骤如下:
S21设定,a、四旋翼飞行器为刚体,机体严格对称;b、质量和重力加速为常值;c、地面坐标系为惯性系;d、忽略地球曲率的影响;e、忽略空气阻力。
S22、四旋翼飞行器在空间的运动需要六个自由度才能完全描述,包括飞行器质心沿着地面惯性坐标系的三个坐标轴的平动位移,即线运动,以及飞行器绕机体坐标系的三个坐标轴的转动运动,即角运动。
S221、线运动方程:
在地面惯性坐标系中,四旋翼飞行器在合外力作用下的线运动方程为:
其中,m为飞行器质量,g为重力加速度;位置坐标为x、y和z;姿态角θ、φ、ψ分别为俯仰角、滚转角和偏航角;
四个旋翼产生的总升力T为:
T=F1+F2+F3+F4 (5)。
S222、角运动方程:
在地面惯性坐标系中,四旋翼飞行器的角运动方程为:
式中,p、q和r分别表示机体坐标系下的滚转角速度、俯仰角速度和偏航角速度;Ix、Iy和Iz分别为绕机体x,y,z三轴的转动惯量;Mx、My和Mz表示机体坐标系下力矩分量,作用在旋翼飞行器上的力矩的计算公式如下:
其中,l表示旋翼中心到飞行器质心的距离,Ir表示旋翼的转动惯量;旋翼飞机力矩由气动力矩和陀螺力矩两部分组成,分别对应式(8)右侧两项。
作为优选步骤S3中,在多旋翼飞行器飞行过程中,测量旋翼PWM波占空比ω1至ω4,通过式(1)、(2)和(3)分别求解每个旋翼升力Fi、力矩Mi和转速Ωi,代入方程(6)至(8)求解姿态角速率p、q和r,以及姿态角θ、φ、ψ;将升力和姿态角代入式(4)求解位置x、y、z和速度最终得到全部导航信息。
与现有技术相比较,本发明所述的基于PWM波占空比的多旋翼飞行器导航方法,通过PWM波占空比,解算多旋翼无人机的动力学方程,获得导航信息。该方法适用于多旋翼飞行器,且要求旋翼升力的方向始终垂直于飞行器的机体平面。通过该方法实现多旋翼飞行器的自主导航功能。
由于多旋翼飞行器的升力、力矩是通过各旋翼高速旋转产生的,升力的方向始终与机体平面垂直。当需要改变飞行方向时,通过改变各旋翼的转速来实现。这也是多旋翼飞行器不同于固定翼飞行器的地方。通过PWM波占空比实现旋翼转速的控制。针对多旋翼飞行器的这种特性,提出一种基于PWM波占空比的多旋翼飞行器导航方法。这种方法仅适用于多旋翼飞行器。
本发明所述的基于PWM波占空比的多旋翼飞行器导航方法,是一种全新的导航方式;无需外源导航信息和额外硬件设备;原理简单,易于实现;成本低,对于多旋翼飞行器的工程应用具有重要价值。
附图说明
下面结合附图和具体实施方式对本发明作进一步详细的说明。
图1是本发明基于PWM波占空比多旋翼飞行器导航方法的实现流程图。
图2是本发明四旋翼飞行器示意图。
具体实施方式
如图1和图2所示,一种基于PWM波占空比的多旋翼飞行器导航方法,包括以下步骤:
S1、通过旋翼台架试验,测试PWM波占空比和旋翼转速、升力、力矩数据,通过数据处理,得到PWM波占空比与旋翼转速、升力、力矩的关系。
步骤S1中,具体的,单个旋翼产生的升力、力矩分别表示为:
Fi=f(ωi) (1)
Mi=h(ωi) (2)
式中,ωi表示第i个旋翼的PWM波占空比,Fi表示第i个旋翼产生的升力,Mi表示第i个旋翼产生的力矩;
旋翼转速Ω表示为
Ωi=k(ωi) (3)。
S2、根据步骤1中PWM波占空比与旋翼转速、升力、力矩的关系,建立多旋翼飞行器动力学方程。
步骤S2中,建立多旋翼飞行器动力学方程的具体步骤如下:
S21设定,a、四旋翼飞行器为刚体,机体严格对称;b、质量和重力加速为常值;c、地面坐标系为惯性系;d、忽略地球曲率的影响;e、忽略空气阻力。
S22、四旋翼飞行器在空间的运动需要六个自由度才能完全描述,包括飞行器质心沿着地面惯性坐标系的三个坐标轴的平动位移,即线运动,以及飞行器绕机体坐标系的三个坐标轴的转动运动,即角运动。
S221、线运动方程:
在地面惯性坐标系中,四旋翼飞行器在合外力作用下的线运动方程为:
其中,m为飞行器质量,g为重力加速度;位置坐标为x、y和z;姿态角θ、φ、ψ分别为俯仰角、滚转角和偏航角;
四个旋翼产生的总升力T为:
T=F1+F2+F3+F4 (5)。
S222、角运动方程:
在地面惯性坐标系中,四旋翼飞行器的角运动方程为:
式中,p、q和r分别表示机体坐标系下的滚转角速度、俯仰角速度和偏航角速度;Ix、Iy和Iz分别为绕机体x,y,z三轴的转动惯量;Mx、My和Mz表示机体坐标系下力矩分量,作用在旋翼飞行器上的力矩的计算公式如下:
其中,l表示旋翼中心到飞行器质心的距离,Ir表示旋翼的转动惯量;旋翼飞机力矩由气动力矩和陀螺力矩两部分组成,分别对应式(8)右侧两项。
S3、根据实际PWM波占空比,解算动力学方程,得到导航信息。
步骤S3中,在多旋翼飞行器飞行过程中,测量旋翼PWM波占空比ω1至ω4,通过式(1)、(2)和(3)分别求解每个旋翼升力Fi、力矩Mi和转速Ωi,代入方程(6)至(8)求解姿态角速率p、q和r,以及姿态角θ、φ、ψ;将升力和姿态角代入式(4)求解位置x、y、z和速度最终得到全部导航信息。
本发明所述的基于PWM波占空比的多旋翼飞行器导航方法,该方法适用于多旋翼飞行器,且要求旋翼升力的方向始终垂直于飞行器的机体平面。通过该方法实现多旋翼飞行器的自主导航功能。首先,测试多旋翼飞行器的旋翼得到升力、力矩、转速与PWM波占空比的对应关系;然后,根据上述关系建立多旋翼飞行器的动力学方程。最后,根据PWM波占空比,解算多旋翼飞行器的动力学方程,获得导航信息。
脉冲宽度调制(PWM)是英文“Pulse Width Modulation”的缩写,旋翼电机受飞控***输出的PWM波控制,通过PWM波的占空比控制旋翼电机的功率。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,根据本发明的技术方案及其发明构思加以等同替换或改变,都应涵盖在本发明的保护范围之内。
Claims (1)
1.一种基于PWM波占空比的多旋翼飞行器导航方法,其特征在于包括以下步骤:
S1、通过旋翼台架试验,测试PWM波占空比和旋翼转速、升力、力矩数据,通过数据处理,得到PWM波占空比与旋翼转速、升力、力矩的关系;
S2、根据步骤1中PWM波占空比与旋翼转速、升力、力矩的关系,建立多旋翼飞行器动力学方程;
S3、根据实际PWM波占空比,解算动力学方程,得到导航信息;
步骤S1中,具体的,单个旋翼产生的升力、力矩分别表示为:
Fi=f(ωi) (1)
Mi=h(ωi) (2)
式中,ωi表示第i个旋翼的PWM波占空比,Fi表示第i个旋翼产生的升力,Mi表示第i个旋翼产生的力矩;
旋翼转速Ω表示为
Ωi=k(ωi) (3);
步骤S2中,建立多旋翼飞行器动力学方程的具体步骤如下:
S21设定,a、四旋翼飞行器为刚体,机体严格对称;b、质量和重力加速度为常值;c、地面坐标系为惯性坐标系;d、忽略地球曲率的影响;e、忽略空气阻力;
S22、四旋翼飞行器在空间的运动需要六个自由度才能完全描述,包括飞行器质心沿着地面惯性坐标系的三个坐标轴的平动位移,即线运动,以及飞行器绕机体坐标系的三个坐标轴的转动运动,即角运动;
S221、线运动方程:
在地面惯性坐标系中,四旋翼飞行器在合外力作用下的线运动方程为:
其中,m为飞行器质量,g为重力加速度;位置坐标为x、y和z;姿态角θ、φ、ψ分别为俯仰角、滚转角和偏航角;
四个旋翼产生的总升力T为:
T=F1+F2+F3+F4 (5);
S222、角运动方程:
在地面惯性坐标系中,四旋翼飞行器的角运动方程为:
式中,p、q和r分别表示机体坐标系下的滚转角速度、俯仰角速度和偏航角速度;Ix、Iy和Iz分别为绕机体x,y,z三轴的转动惯量;Mx、My和Mz表示机体坐标系下力矩分量,作用在旋翼飞行器上的力矩的计算公式如下:
其中,l表示旋翼中心到飞行器质心的距离,Ir表示旋翼的转动惯量;旋翼飞行器力矩由气动力矩和陀螺力矩两部分组成,分别对应式(8)右侧两项;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810374436.5A CN108571969B (zh) | 2018-04-24 | 2018-04-24 | 基于pwm波占空比的多旋翼飞行器导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810374436.5A CN108571969B (zh) | 2018-04-24 | 2018-04-24 | 基于pwm波占空比的多旋翼飞行器导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108571969A CN108571969A (zh) | 2018-09-25 |
CN108571969B true CN108571969B (zh) | 2021-05-14 |
Family
ID=63575260
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810374436.5A Active CN108571969B (zh) | 2018-04-24 | 2018-04-24 | 基于pwm波占空比的多旋翼飞行器导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108571969B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102830622A (zh) * | 2012-09-05 | 2012-12-19 | 北京理工大学 | 一种四旋翼飞行器自抗扰自动飞行控制方法 |
CN104460685A (zh) * | 2014-11-21 | 2015-03-25 | 南京信息工程大学 | 一种四旋翼飞行器的控制***及其控制方法 |
CN106325103A (zh) * | 2016-10-31 | 2017-01-11 | 安徽理工大学 | 四旋翼无人飞行器飞行控制***半物理仿真试验*** |
CN106444813A (zh) * | 2016-10-26 | 2017-02-22 | 成都市优艾维机器人科技有限公司 | 一种基于t‑s模糊模型的四旋翼姿态控制方法 |
CN106990790A (zh) * | 2017-06-06 | 2017-07-28 | 成都纵横自动化技术有限公司 | 一种抗饱和多旋翼飞行器控制方法 |
CN107797567A (zh) * | 2017-12-11 | 2018-03-13 | 福州大学 | 一种内偏转式非平面六旋翼飞行器及控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2016049924A1 (en) * | 2014-09-30 | 2016-04-07 | SZ DJI Technology Co., Ltd. | Systems and methods for flight simulation |
-
2018
- 2018-04-24 CN CN201810374436.5A patent/CN108571969B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102830622A (zh) * | 2012-09-05 | 2012-12-19 | 北京理工大学 | 一种四旋翼飞行器自抗扰自动飞行控制方法 |
CN104460685A (zh) * | 2014-11-21 | 2015-03-25 | 南京信息工程大学 | 一种四旋翼飞行器的控制***及其控制方法 |
CN106444813A (zh) * | 2016-10-26 | 2017-02-22 | 成都市优艾维机器人科技有限公司 | 一种基于t‑s模糊模型的四旋翼姿态控制方法 |
CN106325103A (zh) * | 2016-10-31 | 2017-01-11 | 安徽理工大学 | 四旋翼无人飞行器飞行控制***半物理仿真试验*** |
CN106990790A (zh) * | 2017-06-06 | 2017-07-28 | 成都纵横自动化技术有限公司 | 一种抗饱和多旋翼飞行器控制方法 |
CN107797567A (zh) * | 2017-12-11 | 2018-03-13 | 福州大学 | 一种内偏转式非平面六旋翼飞行器及控制方法 |
Non-Patent Citations (2)
Title |
---|
"四旋翼自主飞行器的控制器设计与仿真";杜红彬 等,;《测控技术》;20161231;第35卷(第3期);83-87页 * |
"基于虚拟仪器的旋翼特性测试平台开发";涂世军 等,;《山东交通学院学报》;20161231;第24卷(第4期);75-80页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108571969A (zh) | 2018-09-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Naidoo et al. | Development of an UAV for search & rescue applications | |
Duc et al. | The quadrotor MAV system using PID control | |
Lozano | Unmanned aerial vehicles: Embedded control | |
CN106249745B (zh) | 四轴无人机的控制方法 | |
Rodić et al. | The modeling and simulation of an autonomous quad-rotor microcopter in a virtual outdoor scenario | |
Huang et al. | Aerodynamics and control of autonomous quadrotor helicopters in aggressive maneuvering | |
Rodić et al. | Modeling and simulation of quad-rotor dynamics and spatial navigation | |
US10464661B2 (en) | Volitant vehicle rotating about an axis and method for controlling the same | |
CN108803639A (zh) | 一种基于反步法的四旋翼飞行器飞行控制方法 | |
Mester et al. | Navigation of an Autonomous Outdoor Quadrotor Helicopter | |
CN102830622A (zh) | 一种四旋翼飞行器自抗扰自动飞行控制方法 | |
CN105151292A (zh) | 分布式矢量推进*** | |
CN106844887B (zh) | 旋翼无人机的动力学建模方法及装置 | |
CN109606674A (zh) | 尾坐式垂直起降无人机及其控制***与控制方法 | |
CN104460685A (zh) | 一种四旋翼飞行器的控制***及其控制方法 | |
WO2010015866A2 (en) | Rotary wing vehicle | |
CN104765272A (zh) | 一种基于pid神经元网络控制(pidnn)的四旋翼飞行器控制方法 | |
CN107329484B (zh) | 油动变距多旋翼飞行器控制***及控制方法 | |
Oosedo et al. | Design and simulation of a quad rotor tail-sitter unmanned aerial vehicle | |
JP2015024705A (ja) | 小型電動ヘリコプタの自動離着陸制御方法 | |
CN107491083A (zh) | 一种基于饱和自适应滑模控制的四旋翼自主着船方法 | |
Kita et al. | Transition between level flight and hovering of a tail-sitter vertical takeoff and landing aerial robot | |
CN111319759B (zh) | 一种空间六自由度独立可控多旋翼无人飞行控制方法 | |
Oosedo et al. | Design and attitude control of a quad-rotor tail-sitter vertical takeoff and landing unmanned aerial vehicle | |
Li et al. | Driving and tilt‐hovering–An agile and manoeuvrable aerial vehicle with tiltable rotors |
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 |