欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2023104564252
申请人: 湖南大学
专利类型:发明专利
专利状态:已下证
专利领域: 控制;调节
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种无线速度测量抗干扰的四旋翼无人机编队控制方法,其特征在于,所述方法包括以下步骤:S100:在三维空间中构建一个由多个四旋翼无人机组成的无人集群系统,并利用牛顿-欧拉方程为每个四旋翼无人机建立带外界扰动和质量变化的动力学模型,基于所述动力学模型的控制目标是设计推力和转矩使每个四旋翼无人机满足预设条件;

S200:设计位置环几何控制器实现各四旋翼无人机对虚拟领航者的轨迹跟踪并结合L1自适应控制方法抵抗平动运动学的外界扰动和四旋翼无人机的质量变化;

S300:引入高阶微分器消除每个四旋翼无人机编队控制中对线速度测量的需求,并利用微分器估计出中间控制变量ui的一阶导和二阶导;

S400:采用旋转矩阵表示四旋翼无人机的姿态,在李代数空间上设计几何姿态控制器实现对虚拟领航者的姿态跟踪并引入L1自适应控制方法抵抗旋转运动学的外界扰动。

2.根据权利要求1所述的方法,其特征在于,建立惯性坐标系I和机体坐标系B,S100中的动力学模型具体为:式中,i表示无人集群系统中四旋翼无人机的编号,和分别表示惯性坐标下每个四旋翼无人机的位置和线速度,Ri∈SO(3)是每个四旋翼无人机的姿态,也表示从机体坐标系到惯性坐标系的旋转矩阵,表示机体坐标系下每个四旋翼无人机的角速度,分别表示pi,vi,Ri,Ωi的一阶微分,符号“^”表示把向量映射成相应的反对称矩阵,g为恒定的重力加速度,e3=[0,0,1]T,m0,i表示每个四旋翼无人机的标准质量,mΔ,i表示每个四旋翼无人机变化的质量,为每个四旋翼无人机的转动惯量,和分别表示每个四旋翼无人机的推力和转矩,df,i和dτ,i分别为每个四旋翼无人机平动动力学和旋转动力学的外界扰动。

3.根据权利要求2所述的方法,其特征在于,S100中的预设条件具体为:式中,j是四旋翼无人机的编号,与无人机i相邻,δij表示无人机i和j之间的相对位置,决定所需的编队模式,p0是虚拟领航者的时变轨迹,是p0的一阶微分,表示虚拟领航者的时变速度也即编队队形的参考线速度。

4.根据权利要求3所述的方法,其特征在于,S200包括:S210:定义无人集群系统中每个四旋翼无人机与虚拟领航者的单机跟踪误差如下:式中,δi表示第i个四旋翼无人机与虚拟领航者的期望相对位置,ex,i、ex,i分别表示第i个四旋翼无人机相对于虚拟领航者的位置跟踪误差和速度跟踪误差;

S220:根据有向图理论,无人集群系统中每架四旋翼无人机的编队跟踪误差可以由下式给出:式中,ξx,i、ξv,i分别表示第i个四旋翼无人机的编队位置跟踪误差和编队速度跟踪误差,Ni是能与第i个四旋翼无人机发生相互作用的无人机动态邻域集,ai0是第i个四旋翼无人机与虚拟领航者之间的通信拓扑值,如果四旋翼无人机i与领航者能通信则ai0的值为1,否则为0,aij是邻接矩阵中的元素,aij的值由下式给出:S230:基于PD设计中间辅助控制变量ub,i=-fiRie3如下:式中,kx,kv是正增益控制参数,为虚拟领航者的加速度;

S240:定义则每个四旋翼无人机位置误差动态方程表示为:式中是零矩阵,是单位矩阵;

S250:为每个四旋翼无人机设计位置L1自适应控制律uad,i,其中,状态预测器为:式中,表示预测误差,是用户选择的对角赫尔维茨矩阵,能使预测误差以指数形式快速收敛到0;

在t∈[aTs,(a+1)Ts]时间段,分段常数自适应估计律为:式中,a为时间序数,Ts是时间步长,Φ=Aps-1(exp(ApsTs)-I),位置环L1自适应控制律为:

式中,是低通滤波器,wp是滤波器截止频率;

S260:位置环的完整控制器为:

ui=ub,i+uad,i       (11)S270:每个四旋翼无人机的静推力输入如下:

fi=-ui·Rie3     (12)

式中符号“·”表示内积。

5.根据权利要求1所述的方法,其特征在于,S300包括:S310:通过高阶微分器估计出每个四旋翼无人机的线速度和线加速度:式中,为估计误差,k1>0,k2>0,λ>0均是正常数增益,当t≤Tc时,β=0,其他情况下β=1,Tc>0是任意正常数;

S320:利用高阶微分器估计出每个四旋翼无人机的中间控制变量ui的一阶导和二阶导:式中,为估计误差,k3>0,k4>0均是正常数增益。

6.根据权利要求5所述的方法,其特征在于,S400包括:S410:给定任意期望的偏航角γ,获取期望的几何姿态Rd,i=[b1d,i,b2d,i,b3d,i]T表示如下:式中不平行于b3d,i,相应的期望角速度为式中符号“∨”表示把反对称矩阵映射成相应的向量;

S420:在非线性空间SO3上定义结构误差函数为tr(·)表示矩阵的迹,I表示三维单位矩阵,据此,姿态跟踪误差eR,i定义为:式中符号“∨”表示把反对称矩阵映射成相应的向量;

角速度跟踪误差eΩ,i定义为:

eΩ,i=Ωi-RTiRd,iΩd,i       (17)S430:把(1)式中的角速度动态方程改写成如下形式:式中,τb,i和τad,i分别是后面需要设计的姿态几何控制律和姿态L1自适应控制律;

S440:为每个四旋翼无人机设计基本的姿态几何控制转矩:式中KR,KΩ为正增益控制参数,是Ωd,i的一阶微分;

S450:为每个四旋翼无人机设计姿态L1自适应控制律τad,i,其中,状态预测器为:式中是预测误差,是用户选择的对角赫尔维茨矩阵,能使预测误差以指数形式快速收敛到0;

在t∈[aTs,(a+1)Ts]时间段,分段常数自适应估计律为:式中,

姿态环L1自适应控制律为:

式中,是低通滤波器,wa是滤波器截止频率;

S460:每个四旋翼无人机的转矩为:

τi=τb,i+τad,i (23)。