CN113895611A - 全驱万向四旋翼飞行器及其控制方法 - Google Patents
全驱万向四旋翼飞行器及其控制方法 Download PDFInfo
- Publication number
- CN113895611A CN113895611A CN202111366979.0A CN202111366979A CN113895611A CN 113895611 A CN113895611 A CN 113895611A CN 202111366979 A CN202111366979 A CN 202111366979A CN 113895611 A CN113895611 A CN 113895611A
- Authority
- CN
- China
- Prior art keywords
- frame
- rotor
- joint
- platform
- wheel
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 19
- 230000033001 locomotion Effects 0.000 claims abstract description 11
- 238000005096 rolling process Methods 0.000 claims abstract description 8
- 230000007246 mechanism Effects 0.000 abstract description 7
- 238000013461 design Methods 0.000 abstract description 5
- 230000021715 photosynthesis, light harvesting Effects 0.000 abstract description 3
- 239000011159 matrix material Substances 0.000 description 13
- 230000001133 acceleration Effects 0.000 description 4
- 238000004891 communication Methods 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000005381 potential energy Methods 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C27/00—Rotorcraft; Rotors peculiar thereto
- B64C27/04—Helicopters
- B64C27/08—Helicopters with two or more rotors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C27/00—Rotorcraft; Rotors peculiar thereto
- B64C27/04—Helicopters
- B64C27/12—Rotor drives
-
- 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
-
- 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)
- Mechanical 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
本发明提出一种全驱万向四旋翼飞行器及其控制方法,其由两对旋翼组成,能够在任何位置和任何方向飞行。通过框架式的设计能够同时修改所有螺旋桨的倾斜角,从而解耦位置和姿态运动。在机架上安装了四个转子,通过两个转动接头转动机架,实现了两轴(滚动和俯仰)框架机构。这样就避免了采用复杂的闭链机构。这种解决方案不同于其他倾斜螺旋桨的全驱动UAV,它避免了由于螺旋桨轴不平行而产生的内力和能量耗散。具有抵消水平面扰动的能力,提高了飞行的稳定性。特别适用于需要UAV携带夹持器或机械臂来执行操作任务的应用当中。
Description
技术领域
本发明属于小型飞行器、旋翼空气动力学技术领域,尤其涉及一种全驱万向四旋翼飞行器及其控制方法。
背景技术
无人机是基于无线电遥控设备或自身程序控制装置操纵来实现遥控飞行或自主飞行的无人驾驶飞行器。鉴于多旋翼飞行器具有垂直起降、空中悬停、低速飞行以及机动灵活性等优点,多旋翼飞行器被广泛地应用于森林防火、交通监控、资源勘探以及航空摄影等领域,在军事方面,常常被用于侦察探测、网络通信等极具危险性的任务。经典的多旋翼飞行器是一个欠驱动系统,因为螺旋桨产生的推力是沿着平行轴方向,为了抵消外部干扰,自身身体旋转是必需的。在某些应用中,这种限制会非常严重。
发明内容
有鉴于此,为了填补现有技术的空白,克服现有技术中四旋翼螺旋桨的倾斜角控制的限制,避免冗余输入,本发明提供一种全驱万向四旋翼飞行器及其控制方法,将多旋翼系统的优点和全驱动无人机的敏捷性和机动性集合起来,可以解耦位置,并进行各种姿态运动,能够在任何位置和任何方向飞行。
其由两对旋翼组成,能够在任何位置和任何方向飞行。通过框架式的设计能够同时修改所有螺旋桨的倾斜角,从而解耦位置和姿态运动。在机架上安装了四个转子,通过两个转动接头转动机架,实现了两轴(滚动和俯仰)框架机构。这样就避免了采用复杂的闭链机构。这种解决方案不同于其他倾斜螺旋桨的全驱动UAV,它避免了由于螺旋桨轴不平行而产生的内力和能量耗散。具有抵消水平面扰动的能力,提高了飞行的稳定性。特别适用于需要UAV携带夹持器或机械臂来执行操作任务的应用当中。
本发明具体采用以下技术方案:
一种全驱万向四旋翼飞行器,其特征在于,包括用于安装控制组件的平台、移动框架和转子框架;所述移动框架环绕平台设置,并与平台在第一平面构成铰接;所述转子框架环绕移动框架设置,并与移动框架在第二平面构成铰接;所述第一平面和第二平面正交;四个螺旋桨分别安装在所述转子框架上。
其中平台一般用于承载计算硬件、电子器件和传感器等部件。
进一步地,所述平台与移动框架通过第一旋转接头连接,形成滚动关节轴;所述转子框架与移动框架通过与第一旋转接头正交的第二旋转接头连接,形成俯仰关节轴。通过两个转动接头转动机架,实现了两轴(滚动和俯仰)框架机构。
以上设计实现了:在运动过程中,飞行器通过改变转子框架的方向来产生沿任意方向的推力分量。这样,平台可以独立于转子架的任意方向。
进一步地,每一螺旋桨的驱动电机与所述转子框架相对固定设置。相对于现有技术,本发明通过对转子框架的控制可以同时修改所有螺旋桨的倾斜角,从而解耦位置和姿态运动。
进一步地,飞行控制器由位置控制器、姿态控制器和滚距控制器组成。基于双环控制方法:外环实现位置控制器,其输出是为了实现期望的位置轨迹所需要施加到平台上的力和所述滚动关节轴的参考角度;内环根据飞行器的期望方向和所述俯仰关节轴的参考关节角度,计算关节实现期望角运动所需的力矩。
其可以类比现有的航空机械臂的控制方法。
与现有技术相比,本发明及其优选方案提供了一种全驱万向四旋翼飞行器设计方案,避免了采用复杂的闭链机构,这种解决方案不同于其他倾斜螺旋桨的全驱动UAV它避免了由于螺旋桨轴不平行而产生的内力和能量耗散。具有抵消水平面扰动的能力,提高了飞行的稳定性。特别适用于需要UAV携带夹持器或机械臂来执行操作任务的应用当中。
附图说明
下面结合附图和具体实施方式对本发明进一步详细的说明:
图1为本发明实施例全驱万向四旋翼飞行器结构示意图;
图2为本发明实施例全驱万向四旋翼飞行器中滚动关节轴的示意图;
图3为本发明实施例全驱万向四旋翼飞行器中俯仰关节轴的示意图;
图4为本发明实施例全驱万向四旋翼飞行器的飞行平台示意图;
图5为本发明实施例控制系统结构框图。
图中:1-平台;11-控制组件;2-移动框架;3-转子框架;4-螺旋桨。
具体实施方式
为让本专利的特征和优点能更明显易懂,下文特举实施例,作详细说明如下:
如图1-图5所示,本实施例提供的全驱万向四旋翼飞行器包括用于承载控制组件11(主要包括计算硬件、电子器件和传感器)的平台1、移动框架2和转子框架3。其中,移动框架2环绕平台设置,并与平台1在第一平面构成铰接,具体为平台1与移动框架2通过第一旋转接头连接;转子框架3环绕移动框架2设置,并与移动框架2在第二平面构成铰接第一平面和第二平面正交,具体为转子框架与移动框架通过与第一旋转接头正交的第二旋转接头连接;四个螺旋桨4分别安装在转子框架3上。
通过两个转动接头转动机架,实现了两轴(滚动和俯仰)框架机构。在运动过程中,飞行器通过改变转子框架3的方向来产生沿任意方向的推力分量。这样,平台1则可以独立于转子架3的任意方向。
每一螺旋桨4的驱动电机与转子框架3相对固定设置,因此其倾斜角度完全由转子框架3决定。相对于现有技术,本实施例通过对转子框架3的控制可以同时修改所有螺旋桨4的倾斜角,从而解耦位置和姿态运动。
对于控制部分,如图5所示,本实施例飞行控制器由位置控制器、姿态控制器和滚距控制器组成。基基于双环控制方法:外环实现位置控制器,其输出是为了实现期望的位置轨迹所需要施加到平台上的力和万向节的参考角度;内环根据飞行器的期望方向和参考关节角度,计算关节实现期望角运动所需的力矩。其可以类比现有的航空机械臂的控制方法。
本实施例提供下述基于全驱动全驱万向四旋翼飞行器的动力模型作为具体的控制方案。
建立惯性坐标系Σ{O,x,y,z};
坐标系Σ0{O0,x0,y0,z0}与平台相连,其轴x0与滚动接头轴重合;
坐标系Σ1{O1,x1,y1,z1},连接到移动框架上,使x1轴与节距轴重合;
坐标系Σ2{O2,x2,y2,z2},以这样的方式连接到转子框架,轴x1与x2重合。
∑0,∑1和∑2被选为O0≡O1≡O2。坐标系之间的相对方向由下列旋转矩阵给出:
根据欧拉-拉格朗日公式,推导出系统的动力学模型:
其中P0∈IR3为O0相对于惯性系的位置,φ0=[φ θ ψ]T∈IR3为欧拉角向量(如滚动-俯仰-偏转角),α=[α β]T∈IR2为万向节位置。
将坐标系∑C0附在平台的质心C0上,并且与∑0具有相同的方向。C0相对于惯性系的位置可以表示为:
其中r0为表示平台相对于惯性系的姿态的旋转矩阵,r0为向量,C0为C0相对于O0的位置,表达式为∑0。通过微分(6),得到∑C0的线速度和角速度:
考虑一个坐标系∑C1,附加在移动坐标系的质心C1上,并且与∑1具有相同的方向。质心C1的位置,在惯性系中可以表示为:
∑C1的线速度和角速度由:
当
其中X0是R0的第一列。
考虑一个坐标系∑C2它附着在转子坐标系的质心C2上,并且与∑2具有相同的方向。C2的位置在惯性系中可以表示为:
∑2的线速度和角速度是由:
第i个物体(i=0,1,2)的动能T由:
第i个物体(i=0,1,2)的势能U可以写成:
通过(3)(22)(23),动态模型可以写成紧凑形式为:
M(q)∈IR8×8惯性矩阵:
g(q,)∈IR8包含广义引力:
其中f0和μ0分别为作用在平台上的力和力矩,τδ∈IR2为作用在万向节上的力矩。力f0取决于四个螺旋桨的推力,σi(i=1,…4)。这样的推力是沿着Z2轴方向的,因此作用在平台上的总力(∑2)有以下表达式:利用f0可以表示为:
其中L>0为每个电机到原点O2的距离,c=γd/γt,其中γd和γt分别为阻力系数和推力系数。力矩矢量τδ由关节执行器τC所产生的力矩和推力对关节的影响之和给出:
出于控制设计的目的,(24)中的矩阵可以写成块矩阵:
其中Mpp∈IR3×3,Mpφ∈IR3×3,Mpδ∈IR3×2,Mφφ∈IR3×3,Mφδ∈IR3×3和Mδδ∈IR2×2和:
Cp∈IR3×8,Cφ∈IR3×8,Cδ∈IR2×8,Fp∈IR3×8,Fφ∈IR3×8Fδ∈IR2×8gp∈IR3
gφ∈IR3,gδ∈IR2
块分解允许重新安排动态模型(24)为:
位置控制器的控制方法:
位置控制器是基于现有的逆动力学方法,旨在实现闭环动力学的全局线性化。为此目的,将对平台施加的命令力计算为:
姿态和滚距控制器的控制方法;
由(1)和(2)可以得出:
因此,期望的关节角和螺旋桨提供的总推力可以计算为:
关节的期望速度和加速度可以通过数值微分得到。由于在实际应用中,α和β受噪声的影响较大,因此需要使用合适的鲁棒噪声滤波器来计算所需的速度和加速度。采用时变滤波器来计算参考值的一阶和二阶时间导数。
用于平台的命令力矩和关节力矩可按(34)计算:
其中辅助输入γδ被计算为
具有KD,δ,KP,δ和KI,δKI对称和正定增益矩阵。值得注意的是,由于与FP相同的原因,Fφ和Fδ被忽略了。
根据式(30),可计算出四个螺旋桨所能提供的指令总力矩:
最后,通过(31)可以获得转子推力:
本专利不局限于上述最佳实施方式,任何人在本专利的启示下都可以得出其它各种形式的全驱万向四旋翼飞行器及其控制方法,凡依本发明申请专利范围所做的均等变化与修饰,皆应属本专利的涵盖范围。
Claims (6)
1.一种全驱万向四旋翼飞行器,其特征在于,包括用于安装控制组件的平台、移动框架和转子框架;所述移动框架环绕平台设置,并与平台在第一平面构成铰接;所述转子框架环绕移动框架设置,并与移动框架在第二平面构成铰接;所述第一平面和第二平面正交;四个螺旋桨及其驱动电机分别安装在所述转子框架上。
2.根据权利要求1所述的全驱万向四旋翼飞行器,其特征在于:所述平台与移动框架通过第一旋转接头连接,形成滚动关节轴;所述转子框架与移动框架通过与第一旋转接头正交的第二旋转接头连接,形成俯仰关节轴。
3.根据权利要求2所述的全驱万向四旋翼飞行器,其特征在于:每一螺旋桨的驱动电机与所述转子框架相对固定设置。
4.根据权利要求3所述的全驱万向四旋翼飞行器,其特征在于:飞行控制器由位置控制器、姿态控制器和滚距控制器组成。
5.根据权利要求3所述的全驱万向四旋翼飞行器的控制方法,其特征在于:通过控制所述转子框架同时调整所有螺旋桨的倾斜角,从而解耦位置和姿态运动。
6.根据权利要求4所述的全驱万向四旋翼飞行器的控制方法,其特征在于:基于双环控制方法:外环实现位置控制器,其输出是为了实现期望的位置轨迹所需要施加到平台上的力和所述滚动关节轴的参考角度;内环根据飞行器的期望方向和所述俯仰关节轴的参考关节角度,计算关节实现期望角运动所需的力矩。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111366979.0A CN113895611B (zh) | 2021-11-18 | 2021-11-18 | 全驱万向四旋翼飞行器及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111366979.0A CN113895611B (zh) | 2021-11-18 | 2021-11-18 | 全驱万向四旋翼飞行器及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113895611A true CN113895611A (zh) | 2022-01-07 |
CN113895611B CN113895611B (zh) | 2023-04-07 |
Family
ID=79194593
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111366979.0A Active CN113895611B (zh) | 2021-11-18 | 2021-11-18 | 全驱万向四旋翼飞行器及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113895611B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104973242A (zh) * | 2015-06-10 | 2015-10-14 | 胡家祺 | 旋翼控制装置及旋翼飞行器 |
CN105857595A (zh) * | 2016-04-23 | 2016-08-17 | 北京工业大学 | 一种基于云台的小型飞行器系统 |
CN106114851A (zh) * | 2015-05-08 | 2016-11-16 | 光州科学技术院 | 多旋翼式无人飞行体 |
CN106882361A (zh) * | 2017-03-27 | 2017-06-23 | 上海珞鹏航空科技有限公司成都研发分公司 | 一种双旋翼无人机的姿态控制机构 |
CN111661320A (zh) * | 2020-05-28 | 2020-09-15 | 西南交通大学 | 无人机动态避障的控制方法、装置及无人机 |
-
2021
- 2021-11-18 CN CN202111366979.0A patent/CN113895611B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106114851A (zh) * | 2015-05-08 | 2016-11-16 | 光州科学技术院 | 多旋翼式无人飞行体 |
CN104973242A (zh) * | 2015-06-10 | 2015-10-14 | 胡家祺 | 旋翼控制装置及旋翼飞行器 |
CN105857595A (zh) * | 2016-04-23 | 2016-08-17 | 北京工业大学 | 一种基于云台的小型飞行器系统 |
CN106882361A (zh) * | 2017-03-27 | 2017-06-23 | 上海珞鹏航空科技有限公司成都研发分公司 | 一种双旋翼无人机的姿态控制机构 |
CN111661320A (zh) * | 2020-05-28 | 2020-09-15 | 西南交通大学 | 无人机动态避障的控制方法、装置及无人机 |
Also Published As
Publication number | Publication date |
---|---|
CN113895611B (zh) | 2023-04-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Mokhtari et al. | Dynamic feedback controller of Euler angles and wind parameters estimation for a quadrotor unmanned aerial vehicle | |
US11721219B2 (en) | Method for controlling steady flight of unmanned aircraft | |
Erginer et al. | Modeling and PD control of a quadrotor VTOL vehicle | |
Duc et al. | The quadrotor MAV system using PID control | |
CN112684805B (zh) | 一种考虑姿态约束的高机动微型无人机控制方法 | |
Fang et al. | Adaptive backstepping control of an indoor micro-quadrotor | |
Suzuki et al. | Attitude control of quad rotors QTW-UAV with tilt wing mechanism | |
CN111661322A (zh) | T型双旋翼飞行器及控制方法 | |
Subudhi et al. | Modeling and trajectory tracking with cascaded PD controller for quadrotor | |
Nigro et al. | Preliminary design, modeling and control of a fully actuated quadrotor uav | |
Qin et al. | Gemini ii: Design, modeling, and control of a compact yet efficient servoless bi-copter | |
Mokhtari et al. | Sliding mode control for a small coaxial rotorcraft UAV | |
CN111857171B (zh) | 一种基于质量自适应多层神经网络的无人机控制方法 | |
Hrishikeshavan et al. | Control of a quad rotor biplane micro air vehicle in transition from hover to forward flight | |
Salazar-Cruz et al. | Real-time control of a small-scale helicopter having three rotors | |
De Simone et al. | Influence of aerodynamics on quadrotor dynamics | |
Kumar et al. | Design and implementation of fuzzy logic controller for quad rotor UAV | |
Kumar et al. | Mathematical modelling and attitude control of quadcopter based on classical controller | |
Cao et al. | Decoupled translational and rotational flight control designs of canted-rotor hexacopters | |
CN113895611B (zh) | 全驱万向四旋翼飞行器及其控制方法 | |
Song et al. | Research on attitude control of quadrotor uav based on active disturbance rejection control | |
Alcan et al. | Robust hovering control of a quadrotor using acceleration feedback | |
Peng et al. | Nonlinear flight control design for maneuvering flight of quadrotors in high speed and large acceleration | |
CN111338369B (zh) | 一种基于非线性逆补偿的多旋翼飞行控制方法 | |
Cheviron et al. | Generic nonlinear model of reduced scale uavs |
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 |