具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释本发明,而非对本发明的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与本发明相关的部分而非全部结构。此外,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。
实施例一
图1为本发明实施例一提供的一种飞行姿态的控制方法的流程图,本实施例可适用于任一种控制无人机飞行的情况中。本实施例提供的一种飞行姿态的控制方法可以由本发明实施例提供的飞行姿态的控制装置来执行,该装置可以通过软件和/或硬件的方式来实现,并集成在执行本方法的无人机中。
具体的,参考图1,该方法可以包括如下步骤:
S110,根据无人机的当前飞行姿态参数、姿态调节参数和遥控设备为无人机设定的遥控姿态参数,确定无人机的转换控制参数。
具体的,本实施例主要针对无人机在飞行过程中抵抗干扰的问题,其中无人机主要是指多旋翼无人机,通过控制无人机中的多个电机的工作来控制无人机在遇到干扰时的稳定飞行。其中,当前飞行姿态参数是指无人机在飞行过程中当前时刻的姿态角信息,包括无人机的滚转角、俯仰角和偏航角等,可以通过无人机中配置的加速度计、陀螺仪传感器、磁罗盘或者全球定位***(Global Positioning System)模块等姿态传感器来采集无人机在当前时刻的飞行姿态角信息,通过对姿态角的变化情况进行分析,也就是进行对应的姿态解析也可以得到无人机当前的姿态角速率信息,包括滚转角速率、俯仰角速率和偏航角速率等;姿态调节参数是指无人机在飞行过程中形成一个对应的闭环***,通过保证闭环***达到稳定的响应特性而生成的自适应调节参数,以对无人机的当前飞行姿态参数进行调节,进而以使闭环***的响应特性维持稳定为目的来抵抗无人机在飞行过程中遇到的干扰;遥控设备是为无人机配置的、能够控制无人机飞行的遥控器,在遥控设备上能够输入用户期望的无人机在下一时刻的飞行姿态参数,也就是本实施例中的遥控姿态参数,可以包括无人机在下一时刻的飞行姿态角信息;转换控制参数是指无人机中用于从控制器过渡到无人机中的电机工作指令的中间变量,用于对无人机在飞行过程中的飞行姿态进行补偿,以控制无人机在遇到干扰时能保持稳定飞行。
可选的,本实施例在通过各个姿态传感器采集到无人机的当前飞行姿态参数以及通过遥控设备为无人机设定的在下一时刻的遥控姿态参数后,首先可以对当前飞行姿态参数和遥控姿态参数进行分析,确定当前的姿态调节参数,进而采用现有技术中为无人机设定的姿态动力模型,根据当前飞行姿态参数、姿态调节参数和遥控姿态参数,确定出无人机中控制电机工作的转换控制参数。
本实施例中,姿态动力模型为
其中,
表示无人机姿态角变化率;X
2表示无人机飞行姿态角速率;
表示无人机姿态角加速度;u为无人机的转换控制参数;A和B分别为标称的模型参数;K
1和K
2分别为姿态调节参数中的姿态角调节参数和姿态角速率调节参数;示例性的,预先设定
X
2 T=[ω
x,ω
y,ω
z],
其中,
θ和ψ分别为无人机的滚转角、俯仰角和偏航角,ω
x、ω
y和ω
z分别为无人机的滚转角速率、俯仰角速率和偏航角速率;表征无人机在转换控制参数u的作用下,其姿态运动的方式。
此外,本实施例中可以根据无人机所在的闭环***的闭环响应特性来确定对应的姿态调节参数,通过对无人机的姿态调节参数进行实时更新,从而使闭环***的闭环响应特性保持在一个稳定值,以抵抗无人机遇到的干扰。可选的,本实施例中在获取无人机的姿态调节参数之前,还可以包括:根据无人机的当前飞行姿态参数和遥控姿态参数,确定无人机的闭环响应特性参数;根据闭环响应特性参数,确定对应的姿态调节参数。
具体的,无人机的闭环***可以近似为一个二阶***,此时通过采用在线辨识算法对无人机的当前飞行姿态参数和遥控姿态参数进行分析,能够实时估计出无人机在当前时刻飞行下所形成的闭环***的闭环响应特性参数,该闭环响应特性参数包括无人机在闭环***下的阻尼信息和带宽信息;由于预先设定闭环***的闭环响应特性参数保持在一个稳定值,因此本实施例中会设定保证闭环***稳定的阻尼期望值和带宽期望值,此时根据估计出的无人机的闭环响应特性参数中的阻尼信息和带宽信息,以及预先设定的阻尼期望值和带宽期望值之间的差异,确定下一时刻对应的姿态调节参数。
示例性的,预先设定姿态动力模型中的各个参数分别为:
其中,E和Wn分别为无人机的闭环响应特性参数中的阻尼信息和带宽信息;K1、K2、E和Wn中的不同参数分别表示无人机姿态角中的滚转角、俯仰角和偏航角分别对应的参数值;对于无人机姿态角中的滚转角、俯仰角和偏航角中的任一单通道,无人机所在的闭环***近似的二阶***为:
其中,s为拉普拉斯算子,X
1i(s)为无人机滚转角、俯仰角和偏航角中的某一个姿态角;X
1ic(s)为遥控设备为无人机设定的滚转角、俯仰角和偏航角中的某一个遥控姿态角;转换为时域对应的方程为:
其离散形式表示为:
对上式中的参数重新设定:z
2i(k)=X
2i(k+1),h
2i(k)=[X
1ic(k)-X
1i(k),X
2i(k)]
T,
此时现有的在线辨识算法如下所示:
本实施例可以采用上述现有的在线辨识算法能够求得θ
2i(k+1)的估计值
进而通过重新设定的参数
计算出无人机的闭环响应特性参数中的阻尼参数ξ
i(k+1)和带宽参数ω
ni(k+1),同时与预先设定的阻尼期望值ξ
id和带宽期望值ω
nid进行比较,生成对应的姿态调节参数,以便无人机能够稳定保持在阻尼期望值和带宽期望值下。
此时,本实施例对自适应姿态调节参数的更新规律不作具体限定,其中一种更新规律可以为:
其中,γ
1和γ
2为自适应更新常数,由开发者自由设定,而姿态调节参数中的K
1和K
2的初始值为:
K
20=2E
dW
nd,此时
进而通过上述公式迭代得到下一时刻的姿态调节参数K
1和K
2;另一种更新规律也可以为:
ΔK
2(k)=γ
2(E
dW
nd-E(k)W
n(k));而姿态调节参数中的K
1和K
2的初始值为:
K
2(0)=2E
dW
nd,此时K
1(k)=K
1(k-1)+ΔK
1(k),K
2(k)=K
2(k-1)+ΔK
2(k);进而通过上述公式迭代也可以得到下一时刻的姿态调节参数K
1(k+1)和K
2(k+1)。
S120,根据无人机的转换控制参数和当前飞行分配参数,对无人机的飞行姿态进行补偿,得到无人机的目标飞行姿态参数。
其中,当前飞行分配参数是指根据无人机的整体飞行控制量过渡到无人机中控制各个电机进行工作的电机控制量所参考的分配依据,根据该当前飞行分配参数能够将无人机的整体飞行控制量,也就是无人机的转换控制参数,对应分配到无人机的各个电机中,以控制无人机中的各个电机工作。
具体的,本实施例在确定无人机的转换控制参数后,可以根据无人机的转换控制参数和当前飞行分配参数,确定无人机中各个电机的工作指令,进而对无人机的飞行姿态进行补偿,得到无人机的目标飞行姿态参数,也就是无人机在下一时刻实际飞行的姿态参数。
S130,根据目标飞行姿态参数控制无人机飞行。
具体的,在得到无人机在下一时刻的目标飞行姿态参数后,控制无人机按照该目标飞行姿态参数飞行,后续将该时刻作为当前时刻,继续采用本实施例中的飞行姿态的控制方法确定下一时刻的目标飞行姿态参数,进而控制无人机飞行,以保证无人机所在的闭环***保持在稳定的闭环响应特性参数下,能够抵抗无人机遇到的各种干扰,提高飞行姿态的控制精度。
本实施例提供的技术方案,根据无人机的当前飞行姿态参数、姿态调节参数和通过遥控设备设定的在下一时刻的遥控姿态参数,确定无人机中控制电机工作的转换控制参数,进而根据该转换控制参数和无人机中为各电机设定的当前飞行分配参数,实时对无人机的飞行姿态进行补偿,得到无人机在下一时刻的目标飞行姿态参数,并根据该目标飞行姿态参数控制无人机飞行,解决了现有技术中不断估计无人机在飞行过程中的干扰上限,并根据该干扰上限生成适合的控制量来抵抗实际干扰,从而造成无人机机身抖动的问题,本方案实时估计无人机中各项参数的实际值,并依据该实际值自适应调整无人机在下一时刻的飞行姿态参数,减少无人机在飞行过程中的机身抖动,提高无人机飞行姿态的控制精度。
实施例二
图2A为本发明实施例二提供的一种飞行姿态的控制方法的流程图,图2B为本发明实施例二提供的飞行姿态的控制过程的原理示意图。本实施例是在上述实施例的基础上进行优化。可选的,本实施例中主要对控制无人机以稳定的飞行姿态进行飞行的具体飞行过程进行详细的解释说明。
可选的,如图2A所示,本实施例具体可以包括如下步骤:
S210,根据无人机的当前飞行姿态角、姿态角调节参数和遥控姿态角,确定无人机的目标姿态角速率。
具体的,在获取到无人机的当前飞行姿态角和通过遥控设备为无人机设定的的遥控姿态角时,如图2B所示,首先可以将当前飞行姿态角和遥控姿态角进行比对,得到对应的姿态角误差,进而通过根据当前飞行姿态参数和遥控姿态参数确定的姿态角调节参数对该姿态角误差进行调节,得到无人机的目标姿态角速率。
示例性的,根据姿态动力模型
可以得到X
2c=A
-1K
1(X
1c-X
1);其中,X
2c为目标姿态角速率,X
1c为遥控设备为无人机设定的遥控姿态角,X
1为无人机的飞行姿态角,K
1为根据闭环***的闭环响应特性参数预先确定的姿态角调节参数;此时将获取到的飞行姿态角、姿态角调节参数和遥控姿态角输入到上述公式中,可以得到无人机的目标姿态角速率。
S220,根据无人机的当前飞行姿态角速率、姿态角速率调节参数和目标姿态角速率,确定无人机的转换控制参数。
具体的,在获取到无人机的当前飞行姿态角速率和目标姿态角速率时,如图2B所示,首先可以将当前飞行姿态角速率和目标姿态角速率进行比对,得到当前时刻与下一时刻的姿态角速率误差,进而通过根据当前飞行姿态参数和遥控姿态参数确定的姿态角速率调节参数对该姿态角速率误差进行调节,得到无人机的转换控制参数。
示例性的,根据姿态动力模型
可以得到u=B
-1K
2(X
2c-X
2);其中,u为无人机的转换控制参数,X
2c为目标姿态角速率,X
2为无人机的当前飞行姿态角速率,K
2为根据闭环***的闭环响应特性参数预先确定的姿态角速率调节参数;此时将获取到的当前飞行姿态角速率、姿态角速率调节参数和目标姿态角速率输入到上述公式中,可以得到无人机的转换控制参数。
S230,根据无人机的转换控制参数和当前飞行分配参数,确定无人机的电机输入信号。
具体的,如图2B所示,由于无人机的转换控制参数为将无人机的整体控制量向无人机中控制各个电机工作的指令转换的中间变量,此时转换控制参数与无人机中的各个电机之间存在某种指令分配关系,也就是本实施例中的当前飞行分配参数,因此根据无人机的转换控制参数和当前飞行分配参数,执行对应的电机控制分配操作,进而确定无人机中各个电机对应的电机输入信号。
示例性的,由于无人机中电机控制的分配关系为:u=Mv;其中,M为无人机中为各电机设定的当前飞行分配参数组成的矩阵,v为无人机中各个电机的电机输入信号组成的输入矩阵,此时设定:
v
T=[v
1,v
2,......,v
n];而无人机中电机响应存在一个时间常数τ,其等小模型可近似为一个惯性环节,即:
其中,上式表示无人机中各个电机的输入输出传递函数,s为拉普拉斯算子,i为电机编号,设定无人机中存在n个电机,δ
i为第i个电机实际产生的比拉力,δ
ic为第i个电机的期望电机输入产生的比拉力;此时,将无人机的转换控制参数和当前飞行分配参数,分别输入到上述公式中,计算得到无人机中各个电机对应的电机输入信号。
可选的,本施例中根据无人机在当前时刻的飞行姿态参数会实时调整下一时刻的飞行分配参数,以便保证无人机稳定飞行,因此在确定无人机的电机输入信号之前,还可以包括:根据无人机的当前飞行姿态参数和上一时刻的电机输入信号,确定所述当前飞行分配参数。
具体的,本实施例可以通过在线辨识算法对无人机的当前飞行姿态参数和上一时刻的电机输入信号进行分析,实时更新对应的当前飞行分配参数;此时姿态角速率的动力模型为
此时对于无人机姿态角速率中的滚转角速率、俯仰角速率和偏航角速率中的任一单通道,其离散形式可以表示为:X
2i(k+1)=X
2i(k)+Tb
i(k)M
i(k)v(k);其中,M
i(k)=[m
i1,m
i2,......,m
in],表示各个电机在滚转角速率、俯仰角速率和偏航角速率中的任一单通道中对应的分配参数;
对于上式中的参数重新设定:
h
1i(k)=v(k),θ
1i(k)=M
i T(k);
此时现有的在线辨识算法如下所示:
本实施例可以采用上述现有的在线辨识算法能够求得θ
1i(k+1)的估计值
进而通过重新设定的参数θ
1i(k)=M
i T(k)计算出无人机的当前飞行分配参数,以便后续根据该当前飞行分配参数和无人机的转换控制参数,确定无人机中各个电机的点击输入信号。
S240,根据电机输入信号对无人机中的电机进行控制补偿,生成对应的脉冲宽度调制信号。
具体的,在得到无人机中各个电机的电机输入信号时,可以根据该电机输入信号对无人机中得电机进行补偿,得到各个电机对应的脉冲宽度调制(Pulse WidthModulation,PWM)信号,以便控制无人机的稳定飞行。
示例性的,对电机进行补偿的算法如下所示:
其离散形式标识为:
此时将无人机中不同时刻下的电机输入信号输入到上述公式中,计算得到对应的脉冲宽度调制信号。
S250,根据脉冲宽度调制信号确定无人机在下一时刻的目标飞行姿态参数。
具体的,在得到无人机中各个电机的脉冲宽度调制信号后,如图2B所示,将其送入到无人机的各个电机中,进而根据该脉冲宽度调制信号控制对应的电机工作,以控制无人机的姿态变化,确定出无人机的目标飞行姿态参数。
S260,根据目标飞行姿态参数控制无人机飞行。
本实施例提供的技术方案,根据无人机的当前飞行姿态参数、姿态调节参数和通过遥控设备设定的在下一时刻的遥控姿态参数,确定无人机中控制电机工作的转换控制参数,进而根据该转换控制参数和无人机中为各电机设定的当前飞行分配参数,实时对无人机的飞行姿态进行补偿,得到无人机在下一时刻的目标飞行姿态参数,并根据该目标飞行姿态参数控制无人机飞行,解决了现有技术中不断估计无人机在飞行过程中的干扰上限,并根据该干扰上限生成适合的控制量来抵抗实际干扰,从而造成无人机机身抖动的问题,本方案实时估计无人机中各项参数的实际值,并依据该实际值自适应调整无人机在下一时刻的飞行姿态参数,减少无人机在飞行过程中的机身抖动,提高无人机飞行姿态的控制精度。
实施例三
图3为本发明实施例三提供的一种飞行姿态的控制装置的结构示意图,如图3所示,该装置可以包括:
转换参数确定模块310,用于根据无人机的当前飞行姿态参数、姿态调节参数和遥控设备为无人机设定的遥控姿态参数,确定无人机的转换控制参数;
目标姿态确定模块320,用于根据无人机的转换控制参数和当前飞行分配参数,对无人机的飞行姿态进行补偿,得到无人机的目标飞行姿态参数;
姿态控制模块330,用于根据目标飞行姿态参数控制无人机飞行。
本实施例提供的技术方案,根据无人机的当前飞行姿态参数、姿态调节参数和通过遥控设备设定的在下一时刻的遥控姿态参数,确定无人机中控制电机工作的转换控制参数,进而根据该转换控制参数和无人机中为各电机设定的当前飞行分配参数,实时对无人机的飞行姿态进行补偿,得到无人机在下一时刻的目标飞行姿态参数,并根据该目标飞行姿态参数控制无人机飞行,解决了现有技术中不断估计无人机在飞行过程中的干扰上限,并根据该干扰上限生成适合的控制量来抵抗实际干扰,从而造成无人机机身抖动的问题,本方案实时估计无人机中各项参数的实际值,并依据该实际值自适应调整无人机在下一时刻的飞行姿态参数,减少无人机在飞行过程中的机身抖动,提高无人机飞行姿态的控制精度。
进一步的,上述转换参数确定模块310,可以包括:
角速率确定单元,用于根据无人机的当前飞行姿态角、姿态角调节参数和遥控姿态角,确定无人机的目标姿态角速率;
转换参数确定单元,用于根据无人机的当前飞行姿态角速率、姿态角速率调节参数和目标姿态角速率,确定无人机的转换控制参数。
进一步的,上述目标姿态确定模块320,可以包括:
电机信号确定单元,用于根据无人机的转换控制参数和当前飞行分配参数,确定无人机的电机输入信号;
脉冲信号生成单元,用于根据电机输入信号对无人机中的电机进行控制补偿,生成对应的脉冲宽度调制信号;
目标姿态确定单元,用于根据脉冲宽度调制信号确定无人机在下一时刻的目标飞行姿态参数。
进一步的,上述飞行姿态的控制装置,还可以包括:
分配参数确定模块,用于根据无人机的当前飞行姿态参数和上一时刻的电机输入信号,确定当前飞行分配参数。
进一步的,上述飞行姿态的控制装置,还可以包括:
响应特性确定模块,用于根据无人机的当前飞行姿态参数和遥控姿态参数,确定无人机的闭环响应特性参数;
调节参数确定模块,用于根据闭环响应特性参数,确定对应的姿态调节参数。
进一步的,上述闭环响应特性参数包括无人机在闭环***下的阻尼信息和带宽信息。
本实施例提供的飞行姿态的控制装置可适用于上述任意实施例提供的飞行姿态的控制方法,具备相应的功能和有益效果。
实施例四
图4为本发明实施例四提供的一种无人机的结构示意图。如图4所示,该无人机包括处理器40、存储装置41和通信装置42;无人机中处理器40的数量可以是一个或多个,图4中以一个处理器40为例;无人机的处理器40、存储装置41和通信装置42可以通过总线或其他方式连接,图4中以通过总线连接为例。
存储装置41作为一种计算机可读存储介质,可用于存储软件程序、计算机可执行程序以及模块,如本发明实施例中的飞行姿态的控制方法对应的模块。处理器40通过运行存储在存储装置41中的软件程序、指令以及模块,从而执行无人机的各种功能应用以及数据处理,即实现上述的飞行姿态的控制方法。
存储装置41可主要包括存储程序区和存储数据区,其中,存储程序区可存储操作***、至少一个功能所需的应用程序;存储数据区可存储根据终端的使用所创建的数据等。此外,存储装置41可以包括高速随机存取存储器,还可以包括非易失性存储器,例如至少一个磁盘存储器件、闪存器件、或其他非易失性固态存储器件。在一些实例中,存储装置41可进一步包括相对于处理器40远程设置的存储器,这些远程存储器可以通过网络连接至无人机。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
通信装置42可用于实现无人机与遥控设备间网络连接或者移动数据连接。
本实施例提供的一种无人机可用于执行上述任意实施例提供的飞行姿态的控制方法,具备相应的功能和有益效果。
实施例五
本发明实施例五还提供了一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时可实现上述任意实施例中的飞行姿态的控制方法。
该方法具体可以包括:
根据无人机的当前飞行姿态参数、姿态调节参数和遥控设备为无人机设定的遥控姿态参数,确定无人机的转换控制参数;
根据无人机的转换控制参数和当前飞行分配参数,对无人机的飞行姿态进行补偿,得到无人机的目标飞行姿态参数;
根据目标飞行姿态参数控制无人机飞行。
当然,本发明实施例所提供的一种包含计算机可执行指令的存储介质,其计算机可执行指令不限于如上所述的方法操作,还可以执行本发明任意实施例所提供的飞行姿态的控制方法中的相关操作。
通过以上关于实施方式的描述,所属领域的技术人员可以清楚地了解到,本发明可借助软件及必需的通用硬件来实现,当然也可以通过硬件实现,但很多情况下前者是更佳的实施方式。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在计算机可读存储介质中,如计算机的软盘、只读存储器(Read-Only Memory,ROM)、随机存取存储器(RandomAccess Memory,RAM)、闪存(FLASH)、硬盘或光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述的方法。
值得注意的是,上述飞行姿态的控制装置的实施例中,所包括的各个单元和模块只是按照功能逻辑进行划分的,但并不局限于上述的划分,只要能够实现相应的功能即可;另外,各功能单元的具体名称也只是为了便于相互区分,并不用于限制本发明的保护范围。
以上所述仅为本发明的优选实施例,并不用于限制本发明,对于本领域技术人员而言,本发明可以有各种改动和变化。凡在本发明的精神和原理之内所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。