CN110697035B - 一种六自由度独立可控飞行器及其控制方法 - Google Patents
一种六自由度独立可控飞行器及其控制方法 Download PDFInfo
- Publication number
- CN110697035B CN110697035B CN201910869605.7A CN201910869605A CN110697035B CN 110697035 B CN110697035 B CN 110697035B CN 201910869605 A CN201910869605 A CN 201910869605A CN 110697035 B CN110697035 B CN 110697035B
- Authority
- CN
- China
- Prior art keywords
- aircraft
- rotating device
- control
- power system
- expected
- 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
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims abstract description 18
- 230000007246 mechanism Effects 0.000 claims abstract description 14
- 239000013598 vector Substances 0.000 claims description 36
- 239000011159 matrix material Substances 0.000 claims description 25
- 230000002194 synthesizing effect Effects 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 description 10
- 230000008859 change Effects 0.000 description 7
- 238000006073 displacement reaction Methods 0.000 description 6
- 238000005265 energy consumption Methods 0.000 description 5
- 230000005484 gravity Effects 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005315 distribution function Methods 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 241001307210 Pene Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 125000004122 cyclic group Chemical group 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000003993 interaction Effects 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/08—Helicopters with two or more rotors
- B64C27/10—Helicopters with two or more rotors arranged coaxially
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C27/00—Rotorcraft; Rotors peculiar thereto
- B64C27/04—Helicopters
- B64C27/12—Rotor drives
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C27/00—Rotorcraft; Rotors peculiar thereto
- B64C27/32—Rotors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C9/00—Adjustable control surfaces or members, e.g. rudders
- B64C9/06—Adjustable control surfaces or members, e.g. rudders with two or more independent movements
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D27/00—Arrangement or mounting of power plants in aircraft; Aircraft characterised by the type or position of power plants
- B64D27/02—Aircraft characterised by the type or position of power plants
- B64D27/24—Aircraft characterised by the type or position of power plants using steam or spring force
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D27/00—Arrangement or mounting of power plants in aircraft; Aircraft characterised by the type or position of power plants
- B64D27/40—Arrangements for mounting power plants in aircraft
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D35/00—Transmitting power from power plants to propellers or rotors; Arrangements of transmissions
- B64D35/04—Transmitting power from power plants to propellers or rotors; Arrangements of transmissions characterised by the transmission driving a plurality of propellers or rotors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D35/00—Transmitting power from power plants to propellers or rotors; Arrangements of transmissions
- B64D35/04—Transmitting power from power plants to propellers or rotors; Arrangements of transmissions characterised by the transmission driving a plurality of propellers or rotors
- B64D35/06—Transmitting power from power plants to propellers or rotors; Arrangements of transmissions characterised by the transmission driving a plurality of propellers or rotors the propellers or rotors being counter-rotating
-
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T50/00—Aeronautics or air transport
- Y02T50/40—Weight reduction
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
本发明公开了一种六自由度独立可控飞行器及其控制方法,飞行器包括机身、一级转动装置、二级转动装置、动力系统、U形机臂、动力系统安装臂、飞行控制系统;一级转动装置固定在机身上,其转动端通过特定机构与U形机臂连接,可以驱动U形机臂相对于机身以转动。二级转动装置安装在U形机臂上,可以驱动动力系统相对于U形机臂转动。动力系统可以相对于机身发生任意方向的转动,提供任意方向的力和力矩,使得飞行器的六个自由度解耦,可以独立控制。飞行控制系统包含传感器和通信模块。通过飞行控制系统控制一级转动装置、二级转动装置和动力系统进行配合,飞行器可以独立地产生空间六个自由度的力和力矩,实现六自由度独立控制。
Description
技术领域
本发明属于飞行器技术领域,具体一种六自由度独立可控飞行器及其控制方法。
背景技术
传统多旋翼无人机稳定性好、易操控,现已经广泛应用于航拍、搜救等各个领域。然而传统无人机是欠驱动系统,无法实现六个自由度的独立控制,这大大限制了其与物理环境交互的能力,很难实现全地形起降、目标识别跟踪等复杂任务目标。
飞行器始终向着高机动性、高灵活性、高稳定性的方向发展,现需要一种结构简单、保留传统无人机悬停能耗低优势并能六自由度独立控制的飞行器。
已有的相关专利中,中国发明专利公开号CN106892094A中公开了一种六自由度独立可控四旋翼飞行器,使用旋翼短舱和桨毂等机构实现旋翼总距、周期变距操纵,从而使得六自由度独立操控的能力,但是这种结构旋翼倾转范围非常有限,机身姿态角只能保持在一个很小范围内。中国实用新型专利公告号CN208036614U中公开了一种全向飞行器,机架可以相对机身发生转动,但是其结构决定四个电机只能以相同角度同步倾转,而且转动角度有限,只有悬停,飞行和偏航三种飞行模式,不能独立控制机身俯仰和滚转角。中国发明专利公开号CN108515822A中公开了一种陆空两栖全向机器人,旋翼安放在弧形支架上并可以发生倾转,实现了机器人在空中以任意姿态悬停以及在三维空间中朝任意方向运动,但是其旋翼系统分布于空间正四面体的四个顶点,且包含在一个外壳内部,体积较大,失去了四旋翼体积小,结构简单的优势。相关期刊文献中,Ryll M,Bulthoff H H,Giordano P R.ANovel Overactuated Quadrotor Unmanned Aerial Vehicle:Modeling,Control,andExperimental Validation[J].IEEE Transactions on Control Systems Technology,2015,23(2):540-556.和Kamel M,Verling S,Elkhatib O,et al.The VoliroOmnidirectional Hexacopter:An Agile and Maneuverable Tiltable-Rotor AerialVehicle[J].IEEE Robotics&Automation Magazine,2018:1-1.分别公开了旋翼可以绕机臂倾转的四旋翼和六旋翼,实现了六自由度独立控制,但是由于旋翼只能单独方向倾转,存在解算奇异性以及较大的内力抵消。Segui-Gasco P,Al-Rihani Y,Shin H S,et al.ANovel Actuation Concept for a Multi Rotor UAV[C]//International Conference onUnmanned Aircraft Systems.IEEE,2013.中公开了电机具有两个自由度倾转的四旋翼结构,但是同样旋翼转动范围非常有限,不能很好地独立控制六个自由度运动。
发明内容
针对于上述现有技术的不足,本发明的目的在于提供一种六自由度独立可控飞行器及其控制方法,以解决常规飞行器不能实现全向姿态与位置独立控制的问题,以及现有全向飞行器中旋翼倾转范围有限,倾斜姿态下悬停能耗高的问题。
为达到上述目的,本发明采用的技术方案如下:
本发明的一种六自由度独立可控飞行器,包括机身、一级转动装置、二级转动装置、动力系统、U型机臂、动力系统安装臂及飞行控制系统;
所述机身包含上机板,下机板和起落架,所述一级转动装置固定设于上机板和下机板之间;
所述U形机臂、一级转动装置、二级转动装置以及动力系统的数量为四,且一级转动装置呈十字形分布;
所述一级转动装置固定于机身上,其转动端通过一级连接机构与U形机臂相连接;
所述二级转动装置固定于U形机臂上,其转动端通过二级连接机构与动力系统安装臂相连接;
所述动力系统固定在动力系统安装臂上,动力系统安装臂由所述二级转动装置驱动;
所述飞行控制系统获取飞行参数及控制信号,并控制与之电性连接的一级转动装置、二级转动装置以及动力系统,实现对飞行器六个自由度独立运动的控制。
进一步地,所述一级转动装置为舵机,通过一级舵机安装座固定于机身上;舵机的输出端通过一级连接机构与U型机臂连接,并通过一级轴承配合,控制U型机臂相对于机身的转动角度。
进一步地,所述二级转动装置为舵机,通过二级连接机构与动力系统安装臂连接,通过二级轴承配合,动力系统安装于动力系统安装臂上,控制动力系统相对于U型机臂的转动角度。
进一步地,所述动力系统为共轴反桨电机,由反向共轴安装的两个电机和螺旋桨组成。
进一步地,所述动力系统安装臂包括:支撑臂和管夹,管夹固定在支撑臂的中部,管夹上安放所述动力系统,支撑臂通过二级轴承与U型机臂主体配合,并在所述二级转动装置的驱动下转动。
本发明的一种六自由度独立可控飞行器的控制方法,基于上述飞行器,包括步骤如下:
将飞行器六个自由度的位置和姿态期望信号与当前反馈信号进行对比,并计算出四个一级转动装置和四个二级转动装置的转动角度指令以及四个动力系统的转速指令,使得转动装置与动力系统协调配合,实现对空间六自由度运动指令输入信号的完全跟踪。
进一步地,所述方法具体包括:上层控制和控制分配;其中,上层控制通过将飞行器六个自由度的位置和姿态期望信号与当前反馈信号进行对比,生成伪控制量;控制分配将伪控制量映射到四个一级转动装置和四个二级转动装置的转动角度指令以及四个动力系统的转速指令。
进一步地,所述控制分配具体形式为:
1)建立六自由度独立可控飞行器中8个转动装置的转动量以及4个动力系统的转速量关于机身坐标系下期望力和期望力矩的函数关系;
2)利用步骤1)中得到的函数关系,由上层控制所计算出的期望力和期望力矩,求解转动装置以及动力系统的期望转动量及期望升力量。
进一步地,所述控制分配具体还包括:先将转动量以及升力量合成为电机升力矢量;建立四个电机升力矢量与期望力和期望力矩的关系;通过伪逆矩阵由期望力和期望力矩计算出升力矢量,再由升力矢量计算出转动装置转动量以及动力系统升力量。
进一步地,所述控制分配具体还包括:所述的转动量以及升力量合成为升力矢量的具体形式为:
设αi为第i号一级舵机转动角度,βi为第i号二级舵机转动角度,为第i号机臂上两个电机的转速;i=1,2,3,4,由于电机坐标系相对于机身始终固定,当电机分别绕自身轴Y轴转动β角,X轴转动α角后,旋翼产生的拉力在电机坐标系下所投影的升力矢量Fi为:
其中,Kf为共轴反桨的等效旋翼升力系数;
四个电机上的升力矢量与期望力Fdes和期望力矩Mdes关系的具体形式为:
其中,A为分配矩阵,U为控制量向量,Ui为i号电机系下控制量向量,bRi为从i号电机坐标系到机身坐标系的转换矩阵,[r1]×为第i电机系到机身的叉乘矩阵;
所述伪逆分配的具体形式为:
电机转速平方以及舵机转动角度分别为:
进一步地,所述控制分配具体还包括:分配矩阵A作为一个固定矩阵,由飞行器结构所确定,在建模时进行计算并将矩阵存放在控制器中直接实现控制分配,不需要在控制中进行摩尔彭斯伪逆的运算,减少飞行控制系统的运算量。
进一步地,所述控制分配具体还包括:伪逆分配的计算结果满足min||U-Up||,当前控制分配根据优化目标向量Up的选取,改变分配函数计算结果,从而设置不同的飞行模式。
进一步地,所述控制分配具体还包括:优化目标向量Up选取为Up=0,从而使得计算结果为min||U||,此时控制分配所计算的解满足电机转速平方和最小,对应电机能耗最小的飞行模式。
本发明的有益效果:
1、本发明采用可二自由度转动的机构设计,能够控制旋翼拉力在空间中任意角度,实现六自由度独立控制。
2、本发明在实现六自由度独立控制的基础上,能改变转动装置、动力装置的状态而发生六个自由度状态的改变,从而实现更加复杂的任务目标。
3、本发明的控制方法,能实现该飞行器在任意六自由度状态下始终以最小能耗方式飞行。
附图说明
图1为空间六自由度独立可控飞行器总体结构图。
图2为空间六自由度独立可控飞行器机身内部结构图。
图3为空间六自由度独立可控飞行器机臂结构图。
具体实施方式
为了便于本领域技术人员的理解,下面结合实施例与附图对本发明作进一步的说明,实施方式提及的内容并非对本发明的限定。
参照图1至图3所示,本发明的一种六自由度独立可控飞行器,包括机身1、一级转动装置7、二级转动装置4、动力系统3、U型机臂2、动力系统安装臂及飞行控制系统5;
所述机身1包含上机板16,下机板17和起落架6,所述一级转动装置7固定设于上机板和下机板之间;
所述一级转动装置7固定于机身1上,其转动端通过一级连接机构9与U形机臂2相连接;
所述二级转动装置4固定于U形机臂2上,其转动端通过二级连接机构11与动力系统安装臂相连接;
所述动力系统3固定在动力系统安装臂上,后者由所述二级转动装置4驱动;
所述飞行控制系统5获取飞行参数及控制信号,并控制与之电性连接的一级转动装置7、二级转动装置4以及动力系统3,实现对飞行器六个自由度独立运动的控制。
所述U形机臂2、一级转动装置7、二级转动装置4以及动力系统3的数量为四,且一级转动装置7呈十字形分布。
所述一级转动装置7为舵机,通过一级舵机安装座8固定于机身1上;舵机的输出端通过一级连接机构9与U型机臂2连接,并通过一级轴承10配合,控制U型机臂2相对于机身1的转动角度,所述的一级连接机构9为法兰。
所述二级转动装置4为舵机,通过二级连接机构11与动力系统安装臂连接,通过二级轴承12配合,动力系统3安装于动力系统安装臂上,控制动力系统3相对于U型机臂2的转动角度,所述的二级连接机构11为法兰。
所述动力系统3为共轴反桨电机,由反向共轴安装的两个电机和螺旋桨14组成。
所述动力系统安装臂包括:支撑臂13和管夹15,管夹15固定在支撑臂13的中部,管夹上安放所述动力系统,支撑臂13通过二级轴承12与U型机臂2主体配合,并在所述二级转动装置4的驱动下转动。
本发明的一种六自由度独立可控飞行器的控制方法,包括步骤如下:
将飞行器六个自由度的期望信号与当前反馈信号进行对比,并计算出四个一级转动装置和四个二级转动装置的转动角度指令,及四个动力系统的转速指令,使得转动装置与动力系统协调配合,实现对空间六自由度输入信号的完全跟踪。
所述方法具体包括:上层控制和控制分配;其中,上层控制通过将飞行器六个自由度的期望信号与当前反馈信号进行对比,生成伪控制量;控制分配将伪控制量映射到四个一级转动装置和四个二级转动装置的转动角度指令,及四个动力系统的转速指令。
优选地,所述六个自由度为:上下位置,左右位置,前后位置,俯仰角度,偏航角度,姿态角度;上层控制将六自由度期望信号与六自由度反馈信号计算误差,经过串级PID生成机身期望力与期望力矩。
将得到的期望机体角速度ωB,d与反馈得到的机体角速度ωB,f计算误差,通过内环PID控制器得到机身系下的期望角加速度:
通过牛顿定律,得到机身系下的期望力Fb,des和期望力矩Mb,des,并输出为伪控制量τdes,
Mb,des=IωB,d
其中,wRb为从机身坐标系到惯性系下的旋转矩阵,m为机身质量,I为机身转动惯量。
所述控制分配具体步骤为:
1)建立六自由度独立可控飞行器中8个转动装置的转动量以及4个动力系统的转速量关于机身坐标系下期望力和期望力矩的函数关系;
2)利用步骤1)中得到的函数关系,由上层控制所计算出的期望力和期望力矩,求解转动装置以及动力系统的期望转动量及期望升力量。
所述控制分配具体还包括:先将转动量以及升力量合成为电机升力矢量;建立四个电机升力矢量与期望力和期望力矩的关系;通过伪逆矩阵由期望力和期望力矩计算出升力矢量,再由升力矢量计算出转动装置转动量以及动力系统升力量。
所述控制分配具体还包括:所述的转动量以及升力量合成为升力矢量的具体形式为:
设αi为第i号一级舵机转动角度,βi为第i号二级舵机转动角度,为第i号机臂上两个电机的转速;i=1,2,3,4,由于电机坐标系相对于机身始终固定,当电机分别绕自身轴Y轴转动β角,X轴转动α角后,旋翼产生的拉力在电机坐标系下所投影的升力矢量Fi为:
其中,Kf为共轴反桨的等效旋翼升力系数;
四个电机上的升力矢量与期望力Fdes和期望力矩Mdes关系的具体形式为:
其中,A为分配矩阵,U为控制量向量,Ui为i号电机系下控制量向量,bRi为从i号电机坐标系到机身坐标系的转换矩阵,[r1]×为第i电机系到机身的叉乘矩阵;
所述伪逆分配的具体形式为:
电机转速平方以及舵机转动角度分别为:
所述控制分配具体还包括:分配矩阵A作为一个固定矩阵,由飞行器结构所确定,在建模时进行计算并将矩阵存放在控制器中直接实现控制分配,不需要在控制中进行摩尔彭斯伪逆的运算,减少飞行控制系统的运算量。
所述控制分配具体还包括:伪逆分配的计算结果满足min||U-Up||,当前控制分配根据优化目标向量Up的选取,改变分配函数计算结果,从而设置不同的飞行模式。
所述控制分配具体还包括:优化目标向量Up选取为Up=0,从而使得计算结果为min||U||,此时控制分配所计算的解满足电机转速平方和最小,对应电机能耗最小的飞行模式。
所述转动装置和动力系统内部可以有独立的底层控制,用于控制其实际输出达到控制分配解算出的指令。
实施例1
本实施例介绍本发明垂直起飞、零姿态角悬停、垂直降落的实现方式。
通过操作电机转速、舵机转角即可实现垂直起飞、零姿态角悬停、垂直降落任务,具体过程为:飞行器在水平平台上,通电后电机驱动旋翼旋转,飞行控制系统接收信号与当前反馈信号,并进行计算,通过六自由度独立可控飞行器的控制方法,解算出舵机、电机的指令信号。当拉力克服重力,飞行器垂直起飞;当拉力等于重力时,飞行器悬停,此时无力矩,为零姿态角;拉力小于重力,垂直降落。
实施例2
本实施例介绍在任意姿态角下产生线位移的实现方式。
当飞行器在空中以任意姿态悬停时,飞行控制系统接收到线位移信号与当前位置反馈信号,并进行计算,通过六自由度独立可控飞行器的控制方法,解算出舵机、电机的指令信号。此时通过舵机和电机的配合,只产生使机身运动的力,而不产生力矩,机体只发生线位移而姿态角保持不变。
实施例3
本实施例介绍在任意线位移状态下产生姿态角变化的实现方式。
当飞行器在空中以任意姿态悬停时,飞行控制系统接收到姿态角变化信号与当前姿态角反馈信号,并进行计算,通过六自由度独立可控飞行器的控制方法,解算出舵机、电机的指令信号。此时通过舵机和电机的配合,只产生使机身运动的力矩,而不产生力,机体只发生姿态角变化而线位移状态保持不变。
实施例4
本实施例介绍在任意飞行状态下控制舵机角度变化而对飞行状态不产生影响的实现方式。
当飞行器在空中以任意飞行状态运动时,可以通过六自由度独立可控飞行器的控制方法,夺取一个或几个舵机角度的控制权,而对飞行状态不产生影响,具体过程为:飞行控制系统接收一个或几个舵机控制信号,通过六自由度独立可控飞行器的控制方法,解算出此时的控制量向量,输入给电机和其余舵机,通过重新分配的电机转速和其余舵机角度进行配合,使得机体飞行状态不发生变化。
本发明具体应用途径很多,以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以作出若干改进,这些改进也应视为本发明的保护范围。
Claims (1)
1.一种六自由度独立可控飞行器的控制方法,基于六自由度独立可控飞行器,包括机身(1)、一级转动装置(7)、二级转动装置(4)、动力系统(3)、U型机臂(2)、动力系统安装臂及飞行控制系统(5);
所述机身(1)包含上机板(16),下机板(17)和起落架(6),所述一级转动装置(7)固定设于上机板(16)和下机板(17)之间;
所述U型机臂(2)、一级转动装置(7)、二级转动装置(4)以及动力系统(3)的数量为四,且一级转动装置(7)呈十字形分布;
所述一级转动装置(7)固定于机身(1)上,其转动端通过一级连接机构(9)与U型机臂(2)相连接;
所述二级转动装置(4)固定于U型机臂(2)上,其转动端通过二级连接机构(11)与动力系统安装臂相连接;
所述动力系统(3)固定在动力系统安装臂上,动力系统安装臂由所述二级转动装置(4)驱动;
所述飞行控制系统(5)获取飞行参数及控制信号,并控制与之电性连接的一级转动装置(7)、二级转动装置(4)以及动力系统(3),实现对飞行器六个自由度独立运动的控制;
其特征在于,包括步骤如下:
将飞行器六个自由度的位置和姿态期望信号与当前反馈信号进行对比,并计算出四个一级转动装置和四个二级转动装置的转动角度指令以及四个动力系统的转速指令,使得转动装置与动力系统协调配合,实现对空间六自由度运动指令输入信号的完全跟踪;
所述方法具体包括:上层控制和控制分配;其中,上层控制通过将飞行器六个自由度的位置和姿态期望信号与当前反馈信号进行对比,生成伪控制量;控制分配将伪控制量映射到四个一级转动装置和四个二级转动装置的转动角度指令以及四个动力系统的转速指令;
所述控制分配具体形式为:
1)建立六自由度独立可控飞行器中8个转动装置的转动量以及4个动力系统的转速量关于机身坐标系下期望力和期望力矩的函数关系;
2)利用步骤1)中得到的函数关系,由上层控制所计算出的期望力和期望力矩,求解转动装置以及动力系统的期望转动量及期望升力量;
所述控制分配具体还包括:先将转动量以及升力量合成为电机升力矢量;建立四个电机升力矢量与期望力和期望力矩的关系;通过伪逆矩阵由期望力和期望力矩计算出升力矢量,再由升力矢量计算出转动装置转动量以及动力系统升力量;
所述控制分配具体还包括:所述的转动量以及升力量合成为升力矢量的具体形式为:
设αi为第i号一级舵机转动角度,βi为第i号二级舵机转动角度,为第i号机臂上两个电机的转速;i=1,2,3,4,由于电机坐标系相对于机身始终固定,当电机分别绕自身轴Y轴转动β角,X轴转动α角后,旋翼产生的拉力在电机坐标系下所投影的升力矢量Fi为:
其中,Kf为共轴反桨的等效旋翼升力系数;
四个电机上的升力矢量与期望力Fdes和期望力矩Mdes关系的具体形式为:
其中,A为分配矩阵,U为控制量向量,Ui为i号电机系下控制量向量,bRi为从i号电机坐标系到机身坐标系的转换矩阵,[r1]×为第i电机系到机身的叉乘矩阵;
所述控制分配的具体形式为:
电机转速平方以及舵机转动角度分别为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910869605.7A CN110697035B (zh) | 2019-09-16 | 2019-09-16 | 一种六自由度独立可控飞行器及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910869605.7A CN110697035B (zh) | 2019-09-16 | 2019-09-16 | 一种六自由度独立可控飞行器及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110697035A CN110697035A (zh) | 2020-01-17 |
CN110697035B true CN110697035B (zh) | 2022-07-12 |
Family
ID=69195526
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910869605.7A Active CN110697035B (zh) | 2019-09-16 | 2019-09-16 | 一种六自由度独立可控飞行器及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110697035B (zh) |
Families Citing this family (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111158388B (zh) * | 2020-01-19 | 2023-08-18 | 沈阳无距科技有限公司 | 多旋翼无人机悬停控制方法、装置、多旋翼无人机及存储介质 |
CN111776197B (zh) * | 2020-06-08 | 2024-06-14 | 宁波诺丁汉大学 | 一种螺旋桨稳定调速无人机及其控制方法 |
CN112965508B (zh) * | 2021-02-03 | 2022-02-15 | 北京理工大学 | 多信息反馈的电动并联轮足机器人行走控制方法和系统 |
CN113031636B (zh) * | 2021-03-01 | 2024-02-20 | 之江实验室 | 无人机控制方法、装置、电子设备、无人机和存储介质 |
CN113022845B (zh) * | 2021-05-27 | 2021-08-10 | 北京航空航天大学 | 一种共轴倾转旋翼飞行器及其组合的薄膜类飞行器 |
US11383831B1 (en) * | 2021-06-01 | 2022-07-12 | Hoversurf, Inc. | Methods of vertical take-off/landing and horizontal straight flight of aircraft and aircraft for implementation |
US11541999B2 (en) | 2021-06-01 | 2023-01-03 | Hoversurf, Inc. | Methods of vertical take-off/landing and horizontal straight flight of aircraft and aircraft for implementation |
US11377220B1 (en) | 2021-09-27 | 2022-07-05 | Hoversurf, Inc. | Methods of increasing flight safety, controllability and maneuverability of aircraft and aircraft for implementation thereof |
CN114524082A (zh) * | 2022-03-15 | 2022-05-24 | 远牧(深圳)控股集团有限公司 | 一种无人机模块化机翼电控结构及其使用方法 |
FR3133836A1 (fr) * | 2022-03-22 | 2023-09-29 | Aerix Systems | Drone omnidirectionnel comportant un premier arbre rotatif |
FR3133835A1 (fr) * | 2022-03-22 | 2023-09-29 | Aeryx Systems | Drone omnidirectionnel à encombrement minimal |
CN115108004A (zh) * | 2022-07-19 | 2022-09-27 | 南开大学 | 新型喷气式垂直起降飞行器及其非线性控制方法 |
CN115071971A (zh) * | 2022-07-28 | 2022-09-20 | 江苏大学 | 一种基于矢量四旋翼的水空两栖航行器及控制方法 |
CN115477006B (zh) * | 2022-09-15 | 2023-05-19 | 哈尔滨工业大学 | 一种双轴倾转矢量旋翼飞行器及其扰动补偿控制方法 |
CN116147698A (zh) * | 2023-01-04 | 2023-05-23 | 广东工业大学 | 一种水陆空多栖侦查的监测系统 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106394886A (zh) * | 2016-06-15 | 2017-02-15 | 珠海市磐石电子科技有限公司 | 实现移动起飞的多轴飞行器、辅助起飞的平台及起飞方法 |
CN107010211A (zh) * | 2016-07-28 | 2017-08-04 | 张崎 | 一种可变姿态多旋翼飞行器 |
US10106253B2 (en) * | 2016-08-31 | 2018-10-23 | Bell Helicopter Textron Inc. | Tilting ducted fan aircraft generating a pitch control moment |
CN107757912B (zh) * | 2017-03-03 | 2022-01-14 | 珠海磐磊智能科技有限公司 | 动力装置、飞行器及飞行器控制方法 |
CN108945420B (zh) * | 2018-08-15 | 2023-08-04 | 东北大学 | 一种基于无人机的四轴倾转旋翼机构及倾转方法 |
-
2019
- 2019-09-16 CN CN201910869605.7A patent/CN110697035B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110697035A (zh) | 2020-01-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110697035B (zh) | 一种六自由度独立可控飞行器及其控制方法 | |
AU2017344750B2 (en) | Thrust vectored multicopters | |
US8128033B2 (en) | System and process of vector propulsion with independent control of three translation and three rotation axis | |
NL2017971B1 (en) | Unmanned aerial vehicle | |
EP3725680A1 (en) | Multimodal unmanned aerial systems having tiltable wings | |
JP7443365B2 (ja) | 分離した自由度を有する航空機 | |
CN106892094A (zh) | 一种空间六自由度独立可控四旋翼无人飞行器及其控制方法 | |
WO2010015866A2 (en) | Rotary wing vehicle | |
CN106428527B (zh) | 一种螺旋桨双轴矢量伺服变向装置及垂直起降固定翼无人机 | |
CN105857595A (zh) | 一种基于云台的小型飞行器系统 | |
JP2017518217A (ja) | 固定ロータ推力ベクタリング | |
CN110254703B (zh) | 一种倾转双旋翼自动悬停t型无人机系统 | |
Long et al. | Omnicopter: A novel overactuated micro aerial vehicle | |
KR102245397B1 (ko) | 다중회전익 무인비행체 | |
CN107908193B (zh) | 一种非平面式八旋翼全向飞行器及控制方法 | |
JP2009143268A (ja) | 航空機の飛行制御システム及び飛行制御システムを搭載した航空機 | |
CN114715392A (zh) | 一种变体飞翼式倾转旋翼无人机 | |
CN112173071B (zh) | 一种无人机及其十字盘机构和控制方法 | |
CN112078784A (zh) | 一种全向五旋翼飞行器及控制方法 | |
CN116142497A (zh) | 一种火星无人机及其基于任务流形控制器的控制方法 | |
CN110065629A (zh) | 一种多功能倾转涵道无人飞行器 | |
CN116039977A (zh) | 一种变结构四旋翼系统及其控制方法 | |
KR20240020907A (ko) | 벽면 부착을 위한 준-탈동조화 제어기 기반의 공중 변형 드론 및 그 제어 방법 | |
CN214084749U (zh) | 用于室内环境的紧凑型双旋翼飞行器 | |
Li et al. | HALO: A Safe, Coaxial, and Dual-Ducted UAV Without Servo |
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 |