CN109308074B - 一种无人机重心偏移的补偿方法及*** - Google Patents
一种无人机重心偏移的补偿方法及*** Download PDFInfo
- Publication number
- CN109308074B CN109308074B CN201710630420.1A CN201710630420A CN109308074B CN 109308074 B CN109308074 B CN 109308074B CN 201710630420 A CN201710630420 A CN 201710630420A CN 109308074 B CN109308074 B CN 109308074B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- compensation
- attitude
- moment
- 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 68
- 230000005484 gravity Effects 0.000 title claims abstract description 41
- 230000001133 acceleration Effects 0.000 claims description 29
- 238000004364 calculation method Methods 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 6
- 238000010586 diagram Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 238000004088 simulation Methods 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
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000035772 mutation Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000005096 rolling process Methods 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
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Algebra (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种无人机重心偏移的补偿方法,包括:获取无人机的目标控制力矩;获取所述无人机由重心偏移得到的附加力矩;采用递推最小二乘法辨识出所述无人机所需的补偿力矩;将所述附加力矩和所述补偿力矩添加到目标控制力矩中进行补偿控制;将补偿后的力矩分配给四个电机,以使所述四个电机驱动所述无人机达到目标姿态。本发明还公开了一种无人机重心偏移的补偿***。本发明能够对无人机进行重心偏移补偿控制,有效提升无人机的动态性能和抗干扰能力,进而提升用户的飞行体验。
Description
技术领域
本发明涉及无人机技术领域,尤其涉及一种无人机重心偏移的补偿方法及***。
背景技术
现有技术中,带云台的无人航拍飞行器都会存在飞行器重心与飞行器机体的几何中心不一致的情况,由此产生的重心偏移会导致控制的效果不够理想,尤其在手动模式下,无人机明显会往重心偏移的方向漂移,大大影响了用户尤其是新手的飞行体验和可操作性。因此,有必要针对无人机重心偏移的问题对其进行准确辨识并补偿控制。
发明内容
本发明针对现有技术中存在的问题,提供了一种无人机重心偏移的补偿方法及***,能够对无人机进行重心偏移补偿控制,有效提升无人机的动态性能和抗干扰能力,进而提升用户的飞行体验。
本发明就上述技术问题而提出的技术方案如下:
一方面,本发明提供一种无人机重心偏移的补偿方法,包括:
获取无人机的目标控制力矩;
获取所述无人机由重心偏移得到的附加力矩;
采用递推最小二乘法辨识出所述无人机所需的补偿力矩;
将所述附加力矩和所述补偿力矩添加到目标控制力矩中进行补偿控制;
将补偿后的力矩分配给四个电机,以使所述四个电机驱动所述无人机达到目标姿态。
进一步地,所述获取无人机的目标控制力矩,具体包括:
根据所述无人机的目标姿态角以及由所述无人机当前姿态解算得到的姿态角,计算获得姿态角误差;
根据所述姿态角误差获得目标角速度,并根据所述目标角速度以及由所述无人机当前姿态解算得到的角速度,计算获得姿态角速度误差;
根据所述姿态角速度误差获得所述目标控制力矩。
进一步地,所述采用递推最小二乘法辨识出所述无人机所需的补偿力矩,具体包括:
基于俯仰角方向的总力矩、俯仰角速度、滚转角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述俯仰角方向上所需的补偿力矩;
基于滚转角方向的总力矩、滚转角速度、俯仰角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述滚转角方向上所需的补偿力矩;
基于偏航角方向的总力矩、偏航角加速度、滚转角速度和俯仰角速度,采用所述递推最小二乘法辨识出所述无人机在所述偏航角方向上所需的补偿力矩。
进一步地,所述基于俯仰角方向的总力矩、俯仰角速度、滚转角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述俯仰角方向上所需的补偿力矩,具体包括:
设线性方程组Ax=b,则A(k,:)x=bk,其中,k=1,2,…n,A(k,:)=[ak1,ak2,…,akn],x=[x1,x2,…,xn]T;
所述递推最小二乘法为:
xk+1=xk+Qk[bk-A(k,:)xk],k=1,2,…,n;
Pk+1=[I-QkA(k,:)]Pk;
其中,随机产生初始权值向量x0=rand(n,1),设P0=αI∈Rn×n,α=106~1010,I∈Rn ×n是单位矩阵。
进一步地,所述将补偿后的力矩分配给四个电机,以使所述四个电机驱动所述无人机达到目标姿态,具体包括:
基于所述无人机的重量、转动惯量以及电机到质量中心的臂长,依次将所述俯仰角方向的补偿力矩、所述滚转角方向的补偿力矩、所述偏航角方向的补偿力矩分配给所述四个电机,以调整所述四个电机的转速,使所述四个电机驱动所述无人机达到目标姿态。
另一方面,本发明提供一种无人机重心偏移的补偿***,包括:
第一获取模块,用于获取无人机的目标控制力矩;
第二获取模块,用于获取所述无人机由重心偏移得到的附加力矩;
辨识模块,用于采用递推最小二乘法辨识出所述无人机所需的补偿力矩;
补偿模块,用于将所述附加力矩和所述补偿力矩添加到目标控制力矩中进行补偿控制;以及,
分配模块,用于将补偿后的力矩分配给四个电机,以使所述四个电机驱动所述无人机达到目标姿态。
进一步地,所述第一获取模块具体包括:
姿态角误差计算单元,用于根据所述无人机的目标姿态角以及由所述无人机当前姿态解算得到的姿态角,计算获得姿态角误差;
姿态角速度误差计算单元,用于根据所述姿态角误差获得目标角速度,并根据所述目标角速度以及由所述无人机当前姿态解算得到的角速度,计算获得姿态角速度误差;以及,
获取单元,用于根据所述姿态角速度误差获得所述目标控制力矩。
进一步地,所述辨识模块具体包括:
第一辨识单元,用于基于俯仰角方向的总力矩、俯仰角速度、滚转角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述俯仰角方向上所需的补偿力矩;
第二辨识单元,用于基于滚转角方向的总力矩、滚转角速度、俯仰角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述滚转角方向上所需的补偿力矩;以及,
第三辨识单元,用于基于偏航角方向的总力矩、偏航角加速度、滚转角速度和俯仰角速度,采用所述递推最小二乘法辨识出所述无人机在所述偏航角方向上所需的补偿力矩。
进一步地,所述第一辨识单元具体包括:
方程获取子单元,用于获取所述无人机俯仰角方向的力矩平衡方程其中,Mx为无人机俯仰角方向的总力矩,为滚转角加速度,为俯仰角速度,为偏航角速度,Ixx、Iyy、Izz为无人机的转动惯量,为俯仰角方向的补偿力矩;
设定子单元,用于设线性方程组Ax=b,则A(k,:)x=bk,其中,k=1,2,…n,A(k,:)=[ak1,ak2,…,akn],x=[x1,x2,…,xn]T;以及,
所述递推最小二乘法为:
xk+1=xk+Qk[bk-A(k,:)xk],k=1,2,…,n;
Pk+1=[I-QkA(k,:)]Pk;
其中,随机产生初始权值向量x0=rand(n,1),设P0=αI∈Rn×n,α=106~1010,I∈Rn ×n是单位矩阵。
进一步地,所述分配模块具体用于:
基于所述无人机的重量、转动惯量以及电机到质量中心的臂长,依次将所述俯仰角方向的补偿力矩、所述滚转角方向的补偿力矩、所述偏航角方向的补偿力矩分配给所述四个电机,以调整所述四个电机的转速,使所述四个电机驱动所述无人机达到目标姿态。
本发明实施例提供的技术方案带来的有益效果是:
在无人机重心偏移后,采用递推最小二乘法对无人机所需的补偿力矩进行准确辨识,并将辨识得到补偿力矩添加回目标控制力矩进行补偿控制,以便将补偿后的力矩分配给无人机的四个电机,使无人机达到目标姿态,从而有效提升无人机的动态性能和抗干扰能力,进而提升用户的飞行体验。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明实施例一提供的无人机重心偏移的补偿方法的流程示意图;
图2是本发明实施例一提供的无人机重心偏移的补偿方法中的补偿原理图;
图3是本发明实施例一提供的无人机重心偏移的补偿方法中添加附加力矩后的俯仰角输出波形图;
图4是本发明实施例一提供的无人机重心偏移的补偿方法中补偿控制后的俯仰角输出波形图;
图5是本发明实施例一中无人机实际飞行时对附加力矩的辨识波形图;
图6是本发明实施例二提供的无人机重心偏移的补偿***的结构示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明实施方式作进一步地详细描述。
实施例一
本发明实施例提供了一种无人机重心偏移的补偿方法,参见图1,该方法包括:
S1、获取无人机的目标控制力矩;
S2、获取所述无人机由重心偏移得到的附加力矩;
S3、采用递推最小二乘法辨识出所述无人机所需的补偿力矩;
S4、将所述附加力矩和所述补偿力矩添加到目标控制力矩中进行补偿控制;
S5、将补偿后的力矩分配给四个电机,以使所述四个电机驱动所述无人机达到目标姿态。
需要说明的是,在无人机重心偏移后,获取无人机由重心偏移得到的附加力矩以及无人机的目标控制力矩,同时由递推最小二乘法得到无人机所需的补偿力矩,然后将附加力矩和补偿力矩添加到目标控制力矩中,进行补偿控制,进而由无人机参数将补偿后的力矩分配给四个电机,得到四个电机的转速,从而根据四个电机的转速和传感器数据解算出姿态角信息,以使无人机达到目标姿态。
进一步地,所述获取无人机的目标控制力矩,具体包括:
根据所述无人机的目标姿态角以及由所述无人机当前姿态解算得到的姿态角,计算获得姿态角误差;
根据所述姿态角误差获得目标角速度,并根据所述目标角速度以及由所述无人机当前姿态解算得到的角速度,计算获得姿态角速度误差;
根据所述姿态角速度误差获得所述目标控制力矩。
需要说明的是,如图2所示,由目标姿态角Rtarget与当前姿态解算得到的姿态角Rcurrent,计算获得姿态角误差。由姿态角误差经PD控制器得到目标角速度ωd,然后与当前姿态解算得到的角速度ω,计算获得姿态角速度误差ωerr。由姿态角速度误差ωerr经PID控制器得到目标控制力矩,然后在补偿控制模块将由重心偏移得到的附加力矩ΔMx和由最小二乘辨识得到的补偿力矩添加到目标控制力矩中,进行补偿控制。进而由无人机参数,例如重量、转动惯量、臂长等,将扭矩分配给四个电机得到四个电机的转速,最后由电机转速和四旋翼飞行器动力学模型加上传感器数据解算姿态角信息Rcurrent。其中,姿态角包括俯仰角、滚转角和偏航角。
进一步地,所述采用递推最小二乘法辨识出所述无人机所需的补偿力矩,具体包括:
基于俯仰角方向的总力矩、俯仰角速度、滚转角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述俯仰角方向上所需的补偿力矩;
基于滚转角方向的总力矩、滚转角速度、俯仰角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述滚转角方向上所需的补偿力矩;
基于偏航角方向的总力矩、偏航角加速度、滚转角速度和俯仰角速度,采用所述递推最小二乘法辨识出所述无人机在所述偏航角方向上所需的补偿力矩。
需要说明的是,在对无人机的力矩进行补偿时,会从俯仰角方向、滚转角方向和偏航角方向的力矩分别进行补偿。
进一步地,所述基于俯仰角方向的总力矩、俯仰角速度、滚转角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述俯仰角方向上所需的补偿力矩,具体包括:
设线性方程组Ax=b,则A(k,:)x=bk,其中,k=1,2,…n,A(k,:)=[ak1,ak2,…,akn],x=[x1,x2,…,xn]T;
所述递推最小二乘法为:
xk+1=xk+Qk[bk-A(k,:)xk],k=1,2,…,n;
Pk+1=[I-QkA(k,:)]Pk;
其中,随机产生初始权值向量x0=rand(n,1),设P0=αI∈Rn×n,α=106~1010,I∈Rn ×n是单位矩阵。
需要说明的是,本实施例以获取俯仰角方向的补偿力矩为例进行说明。无人机的力矩平衡方程为:其中,Mx,My,Mz分别为无人机x、y、z三个方向的总力矩,为无人机的转动惯量,p、q、r为角速度,为对应的角加速度,为由于重心偏移在x、y、z三个方向产生的附加力矩。其中,坐标系定义为:原点取在无人机的质心,坐标系与机体固连;X轴与机身设计的纵轴平行,且处于无人机的对称平面内,指向前方;Y轴垂直于无人机对称平面指向右方;Z轴在无人机对称平面内,且垂直于X轴指向下方。整个坐标系符合欧拉坐标系右手定则。
由于考虑无人机在小角度变化飞行的条件下,近似处理后,以x方向,即俯仰方向为例,获得其中,Ixx、Izz-Iyy、为待辨识参数,Mx、为已知量(通过传感器滤波得到或控制回路直接输出)。将递推最小二乘法辨识出的添加到控制回路中,对附加力矩ΔMx进行补偿控制。同理,可以辨识出滚转角方向和偏航角方向的补偿力矩。
进一步地,所述将补偿后的力矩分配给四个电机,以使所述四个电机驱动所述无人机达到目标姿态,具体包括:
基于所述无人机的重量、转动惯量以及电机到质量中心的臂长,依次将所述俯仰角方向的补偿力矩、所述滚转角方向的补偿力矩、所述偏航角方向的补偿力矩分配给所述四个电机,以调整所述四个电机的转速,使所述四个电机驱动所述无人机达到目标姿态。
需要说明的是,理想情况下,四旋翼无人机的动力学模型可以描述为:将其视为有一个力和三个力矩的三维刚体。如下给出了小角度变化条件下的四旋翼无人机的近似动力学模型:
其中,x、y分别为水平面的坐标;z为垂直位置;ψ为绕z轴的偏航角,θ为绕y轴的俯仰角,φ为绕x轴的滚转角;u为源自无人机底部向上的推力;τψ,τθ,τφ分别为偏航力矩、俯仰力矩、滚转力矩。
动态动力学模型:
四个电机提供升力,一般升力正比于转速的平方。若不考虑空气阻力,那么四旋翼的模型简化如下:
其中,φ、θ、ψ分别是机身围绕x轴、y轴、z轴旋转的角度(逆时针);Ix、Iy、Iz分别是机身在三个方向的转动惯量;Jr是转动惯量;l是电机到质量中心的臂长;m是机身的质量;g是加速度(数值为9.81);U1,U2,U3,U4,Ω由下列方程得出:
Ω=Ω2+Ω4-Ω1-Ω3
其中,Ω1,Ω2,Ω3,Ω4分别为四个电机的转速,b,d为待定系数。
利用本发明实施例的方法进行仿真实验。
利用MATLAB软件搭建无人机的仿真模块,在输入端给定俯仰角φ为平均值为0的方波信号,先假设附加力矩ΔMx=0.1,将附加力矩添加到控制回路中,俯仰角φ的波形会出现一个偏移量,如图3所示。添加递推最小二乘法辨识反馈模块后,将的辨识结果补偿到控制回路中,俯仰角φ的变化情况如图4所示。结果表明,辨识收敛后,方波的控制输出满足预设要求。
将递推最小二乘法和补偿控制添加到基于C++的飞控源码中,每次起飞的辨识结果如图5所示(红线突变表示无人机起飞和着陆),结果基本稳定在一个固定值附近。从实际飞行效果观察发现,在室内(无风环境下)手动模式下起飞,无人机基本垂直起飞,没有漂移现象;在室外(有风环境下)手动模式下起飞,无人机在外界扰动情况下会存在一定小范围的漂移,但与未将重心偏移所产生的附加力矩进行补偿处理相比,改善效果已非常明显。
本发明实施例能够在无人机的部分电机发生故障时,根据故障信息对四个电机的控制分配信息进行优化,使四个电机的控制指令与无人机所要达到的姿态和高度呈线性关系,从而使无人机根据优化后的控制分配信息达到其所要达到的姿态和高度,以迅速克服故障对无人机的影响,保证姿态和高度的可控性,保持无人机姿态的稳定性,避免了事故的发生。
实施例二
本发明实施例提供了一种无人机重心偏移的补偿***,能够实现上述无人机重心偏移的补偿方法的所有流程,参见图6,所述无人机重心偏移的补偿***包括:
第一获取模块1,用于获取无人机的目标控制力矩;
第二获取模块2,用于获取所述无人机由重心偏移得到的附加力矩;
辨识模块3,用于采用递推最小二乘法辨识出所述无人机所需的补偿力矩;
补偿模块4,用于将所述附加力矩和所述补偿力矩添加到目标控制力矩中进行补偿控制;以及,
分配模块5,用于将补偿后的力矩分配给四个电机,以使所述四个电机驱动所述无人机达到目标姿态。
进一步地,所述第一获取模块具体包括:
姿态角误差计算单元,用于根据所述无人机的目标姿态角以及由所述无人机当前姿态解算得到的姿态角,计算获得姿态角误差;
姿态角速度误差计算单元,用于根据所述姿态角误差获得目标角速度,并根据所述目标角速度以及由所述无人机当前姿态解算得到的角速度,计算获得姿态角速度误差;以及,
获取单元,用于根据所述姿态角速度误差获得所述目标控制力矩。
进一步地,所述辨识模块具体包括:
第一辨识单元,用于基于俯仰角方向的总力矩、俯仰角速度、滚转角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述俯仰角方向上所需的补偿力矩;
第二辨识单元,用于基于滚转角方向的总力矩、滚转角速度、俯仰角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述滚转角方向上所需的补偿力矩;以及,
第三辨识单元,用于基于偏航角方向的总力矩、偏航角加速度、滚转角速度和俯仰角速度,采用所述递推最小二乘法辨识出所述无人机在所述偏航角方向上所需的补偿力矩。
进一步地,所述第一辨识单元具体包括:
方程获取子单元,用于获取所述无人机俯仰角方向的力矩平衡方程其中,Mx为无人机俯仰角方向的总力矩,为滚转角加速度,为俯仰角速度,为偏航角速度,Ixx、Iyy、Izz为无人机的转动惯量,为俯仰角方向的补偿力矩;
设定子单元,用于设线性方程组Ax=b,则A(k,:)x=bk,其中,k=1,2,…n,A(k,:)=[ak1,ak2,…,akn],x=[x1,x2,…,xn]T;以及,
所述递推最小二乘法为:
xk+1=xk+Qk[bk-A(k,:)xk],k=1,2,…,n;
Pk+1=[I-QkA(k,:)]Pk;
其中,随机产生初始权值向量x0=rand(n,1),设P0=αI∈Rn×n,α=106~1010,I∈Rn ×n是单位矩阵。
进一步地,所述分配模块具体用于:
基于所述无人机的重量、转动惯量以及电机到质量中心的臂长,依次将所述俯仰角方向的补偿力矩、所述滚转角方向的补偿力矩、所述偏航角方向的补偿力矩分配给所述四个电机,以调整所述四个电机的转速,使所述四个电机驱动所述无人机达到目标姿态。
本发明实施例在无人机重心偏移后,采用递推最小二乘法对无人机所需的补偿力矩进行准确辨识,并将辨识得到补偿力矩添加回目标控制力矩进行补偿控制,以便将补偿后的力矩分配给无人机的四个电机,使无人机达到目标姿态,从而有效提升无人机的动态性能和抗干扰能力,进而提升用户的飞行体验。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (8)
1.一种无人机重心偏移的补偿方法,其特征在于,包括:
获取无人机的目标控制力矩;
获取所述无人机由重心偏移得到的附加力矩;
采用递推最小二乘法辨识出所述无人机所需的补偿力矩;
将所述附加力矩和所述补偿力矩添加到所述目标控制力矩中进行补偿控制;
将补偿后的力矩分配给四个电机,以使所述四个电机驱动所述无人机达到目标姿态;
所述采用递推最小二乘法辨识出所述无人机所需的补偿力矩,具体包括:
基于俯仰角方向的总力矩、俯仰角速度、滚转角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述俯仰角方向上所需的补偿力矩;
基于滚转角方向的总力矩、滚转角速度、俯仰角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述滚转角方向上所需的补偿力矩;
基于偏航角方向的总力矩、偏航角加速度、滚转角速度和俯仰角速度,采用所述递推最小二乘法辨识出所述无人机在所述偏航角方向上所需的补偿力矩。
2.如权利要求1所述的无人机重心偏移的补偿方法,其特征在于,所述获取无人机的目标控制力矩,具体包括:
根据所述无人机的目标姿态角以及由所述无人机当前姿态解算得到的姿态角,计算获得姿态角误差;
根据所述姿态角误差获得目标角速度,并根据所述目标角速度以及由所述无人机当前姿态解算得到的角速度,计算获得姿态角速度误差;
根据所述姿态角速度误差获得所述目标控制力矩。
3.如权利要求1所述的无人机重心偏移的补偿方法,其特征在于,所述基于俯仰角方向的总力矩、俯仰角速度、滚转角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述俯仰角方向上所需的补偿力矩,具体包括:
设线性方程组Ax=b,则A(k,:)x=bk,其中,k=1,2,…n,A(k,:)=[ak1,ak2,…,akn],x=[x1,x2,…,xn]T;
所述递推最小二乘法为:
xk+1=xk+Qk[bk-A(k,:)xk],k=1,2,…,n;
Pk+1=[I-QkA(k,:)]Pk;
其中,随机产生初始权值向量x0=rand(n,1),设P0=αI∈Rn×n,α=106~1010,I∈Rn×n是单位矩阵。
4.如权利要求1所述的无人机重心偏移的补偿方法,其特征在于,所述将补偿后的力矩分配给四个电机,以使所述四个电机驱动所述无人机达到目标姿态,具体包括:
基于所述无人机的重量、转动惯量以及电机到质量中心的臂长,依次将所述俯仰角方向的补偿力矩、所述滚转角方向的补偿力矩、所述偏航角方向的补偿力矩分配给所述四个电机,以调整所述四个电机的转速,使所述四个电机驱动所述无人机达到目标姿态。
5.一种无人机重心偏移的补偿***,其特征在于,包括:
第一获取模块,用于获取无人机的目标控制力矩;
第二获取模块,用于获取所述无人机由重心偏移得到的附加力矩;
辨识模块,用于采用递推最小二乘法辨识出所述无人机所需的补偿力矩;
补偿模块,用于将所述附加力矩和所述补偿力矩添加到目标控制力矩中进行补偿控制;以及,
分配模块,用于将补偿后的力矩分配给四个电机,以使所述四个电机驱动所述无人机达到目标姿态;
所述辨识模块具体包括:
第一辨识单元,用于基于俯仰角方向的总力矩、俯仰角速度、滚转角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述俯仰角方向上所需的补偿力矩;
第二辨识单元,用于基于滚转角方向的总力矩、滚转角速度、俯仰角加速度和偏航角速度,采用所述递推最小二乘法辨识出所述无人机在所述滚转角方向上所需的补偿力矩;以及,
第三辨识单元,用于基于偏航角方向的总力矩、偏航角加速度、滚转角速度和俯仰角速度,采用所述递推最小二乘法辨识出所述无人机在所述偏航角方向上所需的补偿力矩。
6.如权利要求5所述的无人机重心偏移的补偿***,其特征在于,所述第一获取模块具体包括:
姿态角误差计算单元,用于根据所述无人机的目标姿态角以及由所述无人机当前姿态解算得到的姿态角,计算获得姿态角误差;
姿态角速度误差计算单元,用于根据所述姿态角误差获得目标角速度,并根据所述目标角速度以及由所述无人机当前姿态解算得到的角速度,计算获得姿态角速度误差;以及,
获取单元,用于根据所述姿态角速度误差获得所述目标控制力矩。
7.如权利要求5所述的无人机重心偏移的补偿***,其特征在于,所述第一辨识单元具体包括:
方程获取子单元,用于获取所述无人机俯仰角方向的力矩平衡方程其中,Mx为无人机俯仰角方向的总力矩,为滚转角加速度,为俯仰角速度,为偏航角速度,Ixx、Iyy、Izz为无人机的转动惯量,为俯仰角方向的补偿力矩;
设定子单元,用于设线性方程组Ax=b,则A(k,:)x=bk,其中,k=1,2,…n,A(k,:)=[ak1,ak2,…,akn],x=[x1,x2,…,xn]T;以及,
所述递推最小二乘法为:
xk+1=xk+Qk[bk-A(k,:)xk],k=1,2,…,n;
Pk+1=[I-QkA(k,:)]Pk;
其中,随机产生初始权值向量x0=rand(n,1),设P0=αI∈Rn×n,α=106~1010,I∈Rn×n是单位矩阵。
8.如权利要求5所述的无人机重心偏移的补偿***,其特征在于,所述分配模块具体用于:
基于所述无人机的重量、转动惯量以及电机到质量中心的臂长,依次将所述俯仰角方向的补偿力矩、所述滚转角方向的补偿力矩、所述偏航角方向的补偿力矩分配给所述四个电机,以调整所述四个电机的转速,使所述四个电机驱动所述无人机达到目标姿态。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710630420.1A CN109308074B (zh) | 2017-07-28 | 2017-07-28 | 一种无人机重心偏移的补偿方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710630420.1A CN109308074B (zh) | 2017-07-28 | 2017-07-28 | 一种无人机重心偏移的补偿方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109308074A CN109308074A (zh) | 2019-02-05 |
CN109308074B true CN109308074B (zh) | 2021-10-08 |
Family
ID=65205114
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710630420.1A Active CN109308074B (zh) | 2017-07-28 | 2017-07-28 | 一种无人机重心偏移的补偿方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109308074B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020181531A1 (zh) * | 2019-03-13 | 2020-09-17 | 深圳市大疆创新科技有限公司 | 云台重心配平的方法、云台及客户端 |
CN110427043B (zh) * | 2019-09-04 | 2021-09-28 | 福州大学 | 基于作业飞行机器人重心偏移的位姿控制器设计方法 |
CN111923047B (zh) * | 2020-08-11 | 2021-08-13 | 北京航空航天大学 | 一种针对质心偏移和基座浮动的带臂旋翼无人机姿态控制方法 |
CN114063626B (zh) * | 2021-09-18 | 2024-01-09 | 航天时代飞鹏有限公司 | 基于重心检测的四旋翼货运无人机飞行姿态控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20120137229A (ko) * | 2011-06-10 | 2012-12-20 | 삼성전자주식회사 | 로봇의 균형 제어 장치 및 그 제어 방법 |
CN106354147A (zh) * | 2016-10-31 | 2017-01-25 | 上海航天控制技术研究所 | 一种基于发动机预摆的大质心横移下的姿轨控耦合控制***与方法 |
CN106647781A (zh) * | 2016-10-26 | 2017-05-10 | 广西师范大学 | 基于重复控制补偿神经模糊pid四旋翼飞行器的控制方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2916868B1 (fr) * | 2007-06-01 | 2009-07-24 | Airbus France Sas | Procede et dispositif de determination de la marge de stabilite dynamique d'un avion. |
CN103885450B (zh) * | 2014-03-03 | 2016-07-06 | 天津大学 | 无人直升机姿态非线性控制方法及验证平台 |
CN103913991A (zh) * | 2014-04-22 | 2014-07-09 | 西北工业大学 | 高速轴对称飞行器复合控制方法 |
CN105739513B (zh) * | 2016-02-05 | 2018-06-12 | 北京航空航天大学 | 一种四旋翼飞行机器人非线性轨迹跟踪控制器及其跟踪控制方法 |
CN205931245U (zh) * | 2016-08-17 | 2017-02-08 | 深圳市大疆创新科技有限公司 | 无人机及控制无人机姿态的控制装置 |
CN106844887B (zh) * | 2016-12-29 | 2020-08-21 | 深圳市道通智能航空技术有限公司 | 旋翼无人机的动力学建模方法及装置 |
CN106647792B (zh) * | 2017-01-25 | 2019-09-03 | 天津大学 | 用于无人机悬挂负载***的抗扰控制方法 |
-
2017
- 2017-07-28 CN CN201710630420.1A patent/CN109308074B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20120137229A (ko) * | 2011-06-10 | 2012-12-20 | 삼성전자주식회사 | 로봇의 균형 제어 장치 및 그 제어 방법 |
CN106647781A (zh) * | 2016-10-26 | 2017-05-10 | 广西师范大学 | 基于重复控制补偿神经模糊pid四旋翼飞行器的控制方法 |
CN106354147A (zh) * | 2016-10-31 | 2017-01-25 | 上海航天控制技术研究所 | 一种基于发动机预摆的大质心横移下的姿轨控耦合控制***与方法 |
Non-Patent Citations (2)
Title |
---|
基于TD-RLS算法的四旋翼飞行器***参数辨识;万慧等;《飞行力学》;20161231;第34卷(第06期);第72~76页 * |
旋翼飞行机械臂建模及重心动态补偿控制;钟杭等;《控制理论与控制工程》;20160331;第33卷(第03期);第311~320页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109308074A (zh) | 2019-02-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109308074B (zh) | 一种无人机重心偏移的补偿方法及*** | |
CN107368091B (zh) | 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法 | |
AU2017344750B2 (en) | Thrust vectored multicopters | |
CN106844887B (zh) | 旋翼无人机的动力学建模方法及装置 | |
Colorado et al. | Mini-quadrotor attitude control based on Hybrid Backstepping & Frenet-Serret theory | |
CN107688295B (zh) | 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法 | |
Oosedo et al. | Flight control systems of a quad tilt rotor unmanned aerial vehicle for a large attitude change | |
WO2019085834A1 (zh) | 一种无人飞行器稳定飞行控制方法 | |
CN106707754B (zh) | 一种基于切换***的货物搬运旋翼无人机建模及自适应控制方法 | |
CN108388269A (zh) | 基于四旋翼飞行器的无人机编队飞行控制方法 | |
CN112644719B (zh) | 用于控制致动器***的方法和使用所述方法的飞行器 | |
CN107844124B (zh) | 一种四旋翼飞行器携带不平衡负载稳定飞行的控制方法 | |
CN104044734A (zh) | 具有可倾斜机翼和旋翼的多旋翼无人机及控制***和方法 | |
CN106802570B (zh) | 一种无人直升机位置跟踪的方法与装置 | |
CN112198885B (zh) | 一种满足机动平台自主降落需求的无人机控制方法 | |
CN111026160A (zh) | 一种四旋翼无人机轨迹跟踪控制方法 | |
CN113039502A (zh) | 多旋翼无人机及其控制方法、控制装置和计算机可读存储介质 | |
CN111976974A (zh) | 一种飞行控制方法、无人机及存储介质 | |
CN115657730A (zh) | 一种大规模多旋翼无人机鲁棒分簇编队控制方法 | |
CN106643710B (zh) | 基于动力学方程的飞行器惯性参数和测压孔压力预示方法 | |
CN113625730A (zh) | 一种基于超扭滑模的四旋翼自适应容错控制方法 | |
CN116149193B (zh) | 一种基于视觉的旋翼无人机抗扰动控制方法及*** | |
CN109634110A (zh) | 一种基于非线性干扰观测器的尾座式无人机过渡段鲁棒控制方法 | |
CN111897219A (zh) | 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法 | |
CN108475066B (zh) | 无人飞行器姿态计算方法、飞行控制器及无人飞行器 |
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 |