一种无人飞行器的过载姿态切换控制方法技术

本发明专利技术提供了一种无人飞行器过载与姿态混合控制并相互切换转换的方法，其通过陀螺仪与加速度计分别测量俯仰角与垂向过载，然后根据指令形成俯仰角误差信号与过载误差信号；然后分别进行奇次变换与指数开方混合变换得到误差综合信号；再分别进行奇次变换、奇次柔化变换并进行立方与线性混合抗饱和分段积分得到误差的非线性平移信号以及误差混合差分信号，再通过上述信号的综合分别得到俯仰姿态控制律与俯仰过载控制律；最后当俯仰角误差较小时采用姿态控制，而俯仰角误差较大时根据过载误差生成过载指令，并切换至过载控制，从而实现了无人飞行器的快速稳定切换控制。现了无人飞行器的快速稳定切换控制。现了无人飞行器的快速稳定切换控制。

【技术实现步骤摘要】
一种无人飞行器的过载姿态切换控制方法


[0001]本专利技术涉及无人飞行器稳定与控制领域，具体而言，涉及一种无人飞行器的过载与姿态的混合切换与控制的方法。

技术介绍

[0002]无人飞行器的控制不仅在民用无人机中有着广泛的应用，而且在军用飞行器的飞行制导中有着重要的地位。目前主流的民用飞行器都是采用的姿态控制，因为其有着强稳定性与可靠性；但在某些军用场合，如制导导引等，需要无人飞行器有着强大的机动能力，此时采用过载控制实现拦截是首选方法。而即使是该类飞行器，在其到达目标之前的平飞飞行过程，仍然是以姿态控制为优。因此采用单一的姿态控制或者过载控制都无法满足上述要求，基于上述背景原因，本专利技术提出了一种能够自由切换与姿态与过载控制的混合控制方法，具有很高的工程应用价值。
[0003]需要说明的是，在上述
技术介绍
部分专利技术的信息仅用于加强对本专利技术的背景的理解，因此可以包括不构成对本领域普通技术人员已知的现有技术的信息。

技术实现思路

[0004]本专利技术的目的在于提供一种无人飞行器的过载姿态切换控制方法，进而克服了由于相关技术的限制和缺陷而导致的姿态控制与过载控制两种不兼容与转换困难的问题。
[0005]根据本专利技术的一个方面，提供一种无人飞行器的过载姿态切换控制方法，包括以下步骤：
[0006]步骤S10，在无人飞行器上安装测角陀螺仪，测量无人飞行器的俯仰角信号，然后根据飞行任务设定俯仰角期望信号，并进行比较得到俯仰角误差信号，然后进行奇次变换，得到俯仰角误差奇次信号；再对俯仰角误差信号进行指数开方混合变换，得到俯仰角误差指数开方信号；最后采用俯仰角误差信号、俯仰角误差奇次信号与俯仰角误差指数开方信号进行叠加得到俯仰角误差综合信号。
[0007]步骤S20，根据所述的俯仰角误差综合信号与俯仰角误差的非线性平移信号进行比较得到俯仰角平移误差信号；然后分别进行奇次变换、奇次柔化变换后得到俯仰角平移误差奇次变换信号与俯仰角平移误差奇次柔化变换信号，再进行叠加后得到俯仰角误差的非线性平移速率信号；然后进行立方与线性混合抗饱和分段积分，得到俯仰角误差的非线性平移信号。
[0008]步骤S30，根据所述的俯仰角误差信号求解俯仰角差分系数信号，然后根据所述的俯仰角误差的非线性平移信号以及俯仰角误差综合信号、俯仰角差分系数信号求解俯仰角误差混合差分信号；再根据俯仰角误差综合信号进行立方与线性混合抗饱和分段积分，得到俯仰角误差综合积分信号；最后叠加俯仰角误差信号、俯仰角误差混合差分信号、俯仰角误差的非线性平移速率信号、俯仰角误差综合信号以及俯仰角误差的非线性平移信号形成俯仰姿态综合控制信号。
[0009]步骤S40，根据飞行任务需要，设定过载期望信号；然后在无人飞行器上安装加速度计，测量飞行器的垂向加速度，然后再计算飞行器的垂向过载信号，再与过载期望信号进行比较得到过载误差信号；然后进行奇次变换，得到过载误差奇次信号；再对过载误差信号进行指数开方混合变换，得到过载误差指数开方信号；最后采用过载误差信号、过载误差奇次信号与过载误差指数开方信号进行叠加得到过载误差综合信号。
[0010]步骤S50，根据所述的过载误差综合信号与过载误差的非线性平移信号进行比较得到过载平移误差信号；然后分别进行奇次变换、奇次柔化变换后得到过载平移误差奇次变换信号与过载平移误差奇次柔化变换信号，再进行叠加后得到过载误差的非线性平移速率信号；然后进行立方与线性混合抗饱和分段积分，得到过载误差的非线性平移信号。
[0011]步骤S60，根据所述的过载误差信号求解过载差分系数信号，然后根据所述的过载误差的非线性平移信号以及过载误差综合信号、过载差分系数信号求解过载误差混合差分信号；再根据过载误差综合信号进行立方与线性混合抗饱和分段积分，得到过载误差综合积分信号；最后叠加过载误差信号、过载误差混合差分信号、过载误差的非线性平移速率信号、过载误差综合信号以及过载误差的非线性平移信号形成俯仰过载综合控制信号。
[0012]步骤S70，根据所述的俯仰角误差信号设置切换阈值，当俯仰角误差小于阈值时，无人飞行器俯仰控制量选取为俯仰姿态综合控制信号；当俯仰角误差大于阈值时，将俯仰角误差转换为过载期望信号，选取无人机俯仰控制量为俯仰过载综合控制信号，实现控制律由姿态控制到快速过载控制的切换，实现飞行器俯仰通道的姿态稳定跟踪。
[0013]在本专利技术的一种示例实施例中，在无人飞行器上安装测角陀螺仪，测量无人飞行器的俯仰角信号，然后根据飞行任务设定俯仰角期望信号，并进行比较得到俯仰角误差信号，然后进行奇次变换，得到俯仰角误差奇次信号；再对俯仰角误差信号进行指数开方混合变换，得到俯仰角误差指数开方信号；最后采用俯仰角误差信号、俯仰角误差奇次信号与俯仰角误差指数开方信号进行叠加得到俯仰角误差综合信号包括：
[0014]e1＝θ
‑
θ
d
；
[0015][0016][0017]e
f
＝c1e1+c2f1+c3f2；
[0018]其中θ为采用陀螺仪测量得到的无人飞行器的俯仰角信号，θ
d
为根据飞行任务设定的俯仰角期望信号，e1为俯仰角误差信号；f1为俯仰角误差奇次信号；w为指数常值参数，ε0为开方变换常值参数，f2为俯仰角误差指数开方信号；c1、c2、c3为常值叠加系数，e
f
为俯仰角误差综合信号。
[0019]在本专利技术的一种示例实施例中，根据所述的俯仰角误差综合信号与俯仰角误差的非线性平移信号进行比较得到俯仰角平移误差信号；然后分别进行奇次变换、奇次柔化变换后得到俯仰角平移误差奇次变换信号与俯仰角平移误差奇次柔化变换信号，再进行叠加后得到俯仰角误差的非线性平移速率信号；然后进行立方与线性混合抗饱和分段积分，得到俯仰角误差的非线性平移信号包括：
[0020]e
f1
(n)＝e
f
(n)
‑
e
f0
(n)；
[0021]e
f2
(n)＝(e
f
(n)
‑
e
f0
(n))
7/13
；
[0022][0023][0024][0025]其中e
f1
为俯仰角平移误差信号；e
f2
为俯仰角平移误差奇次变换信号；ε1为奇次柔化变换常值参数，e
f3
为俯仰角平移误差奇次柔化变换信号，T1、T2、T3为非线性平移的常值参数，e
fd
为俯仰角误差的非线性平移速率信号；e
f0
为俯仰角误差的非线性平移信号，a1为分段积分的常值分段参数，T为积分的时间常数。
[0026]在本专利技术的一种示例实施例中，根据所述的俯仰角误差信号求解俯仰角差分系数信号，然后根据所述的俯仰角误差的非线性平移信号以及俯仰角误差综合信号、俯仰角差分系数信号求解俯仰角误差混合差分信号；再根据俯仰角误差综合本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种无人飞行器的过载姿态切换控制方法，其特征在于以下步骤：步骤S10：在无人飞行器上安装测角陀螺仪，测量无人飞行器的俯仰角信号，然后根据飞行任务设定俯仰角期望信号，并进行比较得到俯仰角误差信号，然后进行奇次变换，得到俯仰角误差奇次信号；再对俯仰角误差信号进行指数开方混合变换，得到俯仰角误差指数开方信号；最后采用俯仰角误差信号、俯仰角误差奇次信号与俯仰角误差指数开方信号进行叠加得到俯仰角误差综合信号如下：e1＝θ
‑
θ
d
；；e
f
＝c1e1+c2f1+c3f2；其中θ为采用陀螺仪测量得到的无人飞行器的俯仰角信号，θ
d
为根据飞行任务设定的俯仰角期望信号，e1为俯仰角误差信号；f1为俯仰角误差奇次信号；w为指数常值参数，ε0为开方变换常值参数，f2为俯仰角误差指数开方信号；c1、c2、c3为常值叠加系数，e
f
为俯仰角误差综合信号；步骤S20，根据所述的俯仰角误差综合信号与俯仰角误差的非线性平移信号进行比较得到俯仰角平移误差信号；然后分别进行奇次变换、奇次柔化变换后得到俯仰角平移误差奇次变换信号与俯仰角平移误差奇次柔化变换信号，再进行叠加后得到俯仰角误差的非线性平移速率信号；然后进行立方与线性混合抗饱和分段积分，得到俯仰角误差的非线性平移信号如下：e
f1
(n)＝e
f
(n)
‑
e
f0
(n)；e
f2
(n)＝(e
f
(n)
‑
e
f0
(n))
7/13
；；；其中e
f1
为俯仰角平移误差信号；e
f2
为俯仰角平移误差奇次变换信号；ε1为奇次柔化变换常值参数，e
f3
为俯仰角平移误差奇次柔化变换信号，T1、T2、T3为非线性平移的常值参数，e
fd
为俯仰角误差的非线性平移速率信号；e
f0
为俯仰角误差的非线性平移信号，a1为分段积分的常值分段参数，T为积分的时间常数；步骤S30，根据所述的俯仰角误差信号求解俯仰角差分系数信号，然后根据所述的俯仰角误差的非线性平移信号以及俯仰角误差综合信号、俯仰角差分系数信号求解俯仰角误差混合差分信号；再根据俯仰角误差综合信号进行立方与线性混合抗饱和分段积分，得到俯
仰角误差综合积分信号；最后叠加俯仰角误差信号、俯仰角误差混合差分信号、俯仰角误差的非线性平移速率信号、俯仰角误差综合信号以及俯仰角误差的非线性平移信号形成俯仰姿态综合控制信号如下：姿态综合控制信号如下：姿态综合控制信号如下：u1＝k1e1+k2e
1d
+k3s1+k4e
fd
+k5e
f
+k6e
f0
；其中sign()为符号函数，e
z
为俯仰角差分系数信号，e
1d
为俯仰角误差混合差分信号；a0为分段积分的常值参数，s1为俯仰角误差综合积分信号；k1、k2、k3、k4、k5、k6为常值控制参数，u1为俯仰姿态综合控制信号；步骤S40，根据飞行任务需要或者根据俯仰角误差，设定过载期望信号；然后在无人飞行器上安装加速度计，测量飞行器的垂向加速度，然后再计算飞行器的垂向过载信号，再与过载期望信号进行比较得到过载误差信号；然后进行奇次变换，得到过载误差奇次信号；再对过载误差信号进行指数开方混合变换，得到过载误差指数开方信号；最后采用过载误差信号、过载误差奇次信号与过载误差指数开方信号进行叠加得到过载误差综合信号如下：信号、过载误差奇次信号与过载误差指数开方信号进行叠加得到过载误差综合信号如下：信号、过载误差奇次信号与过载误差指数开方信号进行叠加得到过载误差综合信号如下：信号、过载误差奇次信号与过载误差指数开方信号进行叠加得到过载误差综合信号如下：e<...

【专利技术属性】
技术研发人员：吴华丽，唐义思，
申请(专利权)人：重庆人文科技学院，
类型：发明
国别省市：