一种带有执行器饱和问题的运动体姿态事件触发控制方法
【技术领域】
[0001] 本发明提供一种带有执行器饱和问题的运动体姿态事件触发控制方法，它为一般 常规运动体提供一种可根据事件触发更新控制器、抗执行机构饱和的跟踪期望姿态的新的 用途广泛的控制方法，属于自动控制技术领域。
【背景技术】
[0002] 对于带有执行机构的运动体，在运动体跟踪期望姿态时，由于运动体的执行机构 存在限位设置，易于引发执行机构饱和的问题；此外，在运动体的运动过程中，常存在数据 负载过大导致控制系统性能下降，甚至将导致系统不稳定等问题。
[0003] 此发明"一种带有执行器饱和问题的运动体姿态事件触发控制方法"是把以上 问题作为切入点，而提出的有针对性、基于运动体线化模型进行控制器设计、可使用于非 线性运动体模型的姿态跟踪控制方法。该方法综合了 LQ抗饱和控制方法和事件触发 (event-triggered)控制理论，改善修复执行机构饱和问题，解决控制系统数据负载过大问 题，并保证闭环系统稳定性，为运动体的姿态跟踪控制工程提供了一种可行高效的设计手 段。
【发明内容】
[0004] 目的：本发明的目的在于提供一种带有执行器饱和问题的运动体姿态事件触发控 制方法，控制工程师可以在结合实际参数的同时，按照该方法实现运动体抗执行机构饱和、 控制系统数据负载过大问题的姿态跟踪控制。
[0005] 技术方案：本发明"一种带有执行器饱和问题的运动体姿态事件触发控制方法"， 其主要内容及步骤是：先根据给定的姿态角期望跟踪值进行误差计算；然后由姿态运动 学方程进行姿态运动学控制计算得到期望角速度；根据LQ抗饱和控制方法和事件触发 (event-triggered)控制理论计算控制器，随后基于运动体的线化动力学方程得到控制量； 最后将此控制量用于运动体非线性模型。在实际工程应用当中，运动体的位置、姿态、速度 等状态量由组合惯导等传感器测量得到，而由该方法计算得到的控制量将传输至执行机 构，即可解决运动体执行机构饱和、控制系统数据负载过大问题的姿态跟踪控制功能。
[0006] 本发明"一种带有执行器饱和问题的运动体姿态事件触发控制方法"，其具体步骤 如下。
[0007] 步骤一给定期望跟踪值：给定期望姿态角：
：；给定期望姿态角速度
〇
[0008] )!；·骤二姿态角跟踪误差计算：计算期望姿态角与实际姿态角之间的误差
;计算期望姿态角速度误差
[0009] 步骤三事件触发（event-triggered)控制器设计：计算反馈增益
[0010] 步骤四计算消除期望姿态角与实际姿态角之间误差所需的无限制控制量，即事 件触发（event-triggered)控制器输出量;设计事件条件。
[0011] 步骤五给定控制量限位：计算消除期望姿态角、期望姿态角速度与实际姿态角、 实际姿态角速度之间误差所需的饱和控制量、
[0012] 步骤六LQ抗饱和控制补偿器设计：计算修正控制量的反馈项1挪和修正状态量的 反馈项
[0013] 步骤七计算经LQ抗饱和控制补偿器修正后的事件触发（event-triggered)控制 器输入和事件触发（event-triggered)控制器输出:__，最终将控制量用于运动体 非线性模型。
[0014] 其中，在步骤一中所述的给定期望姿态角包括：期望姿态角为
，可以是时间或路径的函数
，也可以是定值
；所述的给定期望速度为
，可以是时间或路径的函数也可以是定值
丨。
[0015] 其中，在步骤二中所述的姿态角跟踪误差
，其计算方法如下：
所述的纟
：为姿态角速度误差，其计算方法如下： 其中，||·#为控制参数。
[0016] 其中，在步骤三中所述的反馈增益K。，其计算方法如下： 1)给出线性化运动体状态方程 将一般形式运动体的线化状态方程表达为：
其中，
为状态量，其中，
为姿态 角，外为姿态角速度，為%为期望姿态角，
为期望姿态角速度；塵为 输入量，鐵:为状态误差输出，其中
[0017] 2)设计事件触发（event-triggered)控制器，计算反馈增益Kc 反馈增益的K。计算方法如下： 定义对称正定矩阵χ，0,矩阵Y。和参数μ >〇满足如下线性矩阵不等式：
·::: 解出矩阵X。与Y。从而得到
需要指出的是，事件触发（event-triggered)控制器的输入量μ。为： = e 其中，在步骤四中所述的消除期望姿态角与实际姿态角之间误差所需的无限制控制 量，即事件触发（event-triggered)控制器输出量为，其计算公式如下：
在事件触发（event-triggered)控制的框架中，控制器只在瞬时时间
时更新控制量，如下：
定义状态误差为 选择事件条件为 其中藏，一旦违反了上不等式，则将触发新的控制任务，更新控制量。
[0018] 其中，在步骤五中所述的给定控制量限位，计算消除期望姿态角、期望姿态角速度 与实际姿态角、实际姿态角速度之间误差所需的饱和控制量，其计算方法如下：
其中，为控制量所限定的最小值，μ _为控制量所限定的最大值。
[0019] 其中，在步骤六中所述的LQ抗饱和控制补偿器，修正控制量的反馈项1^^和修正状 态量的反馈项>、，其计算方法步骤如下： 1) LQ抗饱和控制补偿器状态方程为：
LQ抗饱和控制补偿器的输入μ aw为：
2) 计算修正控制量的反馈项和修正状态量的反馈项::_W，其计算方法步骤如下： 1根据LQ抗饱和控制补偿器的状态量与输入的维数选择正定对称方阵胃^和胃# ;选 择常数
[0020] 2定义自由变量矩阵
[0021] 3解线性矩阵不等式（LMI)优化问题，使得Yaw值最小，求出自由变量矩阵Q，U，Y， KjLjXijX2; 使得：
根据优化解方案计算出自由变量矩阵以及反馈量：
修正控制量的反馈项：
修正状态量的反馈项：
其中，在步骤七中所述的经LQ抗饱和控制补偿器修正后的事件触发（event-triggered) 控制器输入/Ca和事件触发（event-triggered)控制器输出·，其计算方法如下：
最终，纖_经饱和非线性环节后得到的:纖雜薄即为用于运动体非线性模型的控制量。
[0022] (3)优点及效果： 本发明"一种带有执行器饱和问题的运动体姿态事件触发控制方法"，与现有技术比， 其优点是： 1) 本方法根据事件触发（event-triggered)控制理论设计得到事件触发（event-triggered) 控制器，能够良好的抑制控制系统数据过载对整个系统的影响，保证系统稳定； 2) 本方法根据抗饱和理论应用LQ抗饱和方法设计抗饱和控制补偿器，使得执行期饱 和问题得到了大幅度有效的改善； 3) 本方法基于线性化模型设计，算法结构简单，步骤简洁高效，响应速度快，易于工程 实现，且能够运用于非线性模型，并保证闭环系统的渐近稳定性。
[0023] 在应用过程中，控制工程师可以根据实际要求给定运动体任意期望姿态角，并将 由该方法计算得到的控制量直接传输至执行机构实现姿态跟踪控制的功能。
[0024]
【附图说明】： 图1为本发明所述控制方法流程框图； 图2为本发明运动体姿态运动示意图。
[0025] 符号说明如下： 鮝經为状态误差输出； Λ Λ为消除期望姿态角与实际姿态角之间误差所需的无限制控制量，即事件触发 (event-triggered)控制器输出量；
为消除期望姿态角与实际姿态角之间误差所需的饱和控制量；
:为修正控制量的反馈项； 为修正状态量的反馈项；
::为经LQ抗饱和控制补偿器修正后的事件触发（event-triggered)控制 器输入量；
为经LQ抗饱和控制补偿器修正后的事件触发（event-triggered)控制器 输出量；
惯性坐标系； 体坐标系。
【具体实施方式】
[0026] 下面结合附图，对本发明中的各部分设计方法作进一步的说明： 本发明"一种带有执行器饱和问题的运动体姿态事件触发控制方法"，见图1所示，其 具体步骤如下： 步骤一：给定期望跟踪值 1) 如图2所示，以运动体质心为原点建立体坐标系·錄:；以地面上任一点为原点建立 惯性坐标系
，其中原点ft为地面任意一点，
指向北