CN113568421B - 兼顾机动控制与稳定控制的挠性卫星姿态控制器及方法 - Google Patents

Abstract

本发明涉及兼顾机动控制与稳定控制的挠性卫星姿态控制器及方法，属于航天器姿态控制领域；包括调度逻辑模块、跟踪微分器、单神经元分流模块、第一控制器、第一结构滤波器、第二控制器和第二结构滤波器；以兼顾姿态机动控制与姿态稳定控制为目标，将非线性跟踪微分器和单神经元分流模块联合使用以实现压缩过渡过程并减小姿态超调量的控制方法；本发明实现了在大角度姿态机动时无需额外的机动路径规划，可以直接用目标姿态进行控制，并且在不延长机动时间的前提下有效确保姿态的平稳性。

Description

兼顾机动控制与稳定控制的挠性卫星姿态控制器及方法

技术领域

本发明属于航天器姿态控制领域，特别涉及一种兼顾机动控制与稳定控制的挠性卫星姿态控制器及方法。

背景技术

卫星在轨姿态控制任务通常包括两种：大角度的姿态机动控制和固定姿态(通常是零姿态)附近的姿态稳定控制。这两种控制的要求各有侧重：姿态机动控制强调过程的快速性和平稳性；姿态稳定控制强调固定姿态附近的稳态精度和姿态稳定度。由于任务要求和内在特点的不同，很难用一种结构固定、参数固定的控制律完成这两种控制任务。目前工程上最常用的做法是：一种控制结构、两套控制参数。对于带有挠性部件的卫星(简称挠性卫星)，控制结构多采用比例积分微分(PID)+结构滤波器形式，用两套不同的PID参数来适应这两种控制任务。这种做法的缺点是：参数切换过程中姿态不够平稳；大角度姿态机动需要配合机动规划来实施，且机动前后往往存在较大的姿态超调。

发明内容

本发明解决的技术问题是：克服现有技术的不足，提出一种兼顾机动控制与稳定控制的挠性卫星姿态控制器及方法，实现了在大角度姿态机动时无需额外的机动路径规划，可以直接用目标姿态进行控制，并且在不延长机动时间的前提下有效确保姿态的平稳性。

本发明解决技术的方案是：

本发明实施例提供一种兼顾机动控制与稳定控制的挠性卫星姿态控制器，包括：

调度逻辑模块，用于接收外部上层模块传来的目标姿态角θ_r和任务类型信息；当判定任务类型为姿态调节控制时，将目标姿态角θ_r发送至第一控制器，并置第二控制器的控制量为0，当判定所述任务类型为姿态机动控制时，则将目标姿态角θ_r发送至跟踪微分器，并置第一控制器的控制量为0；

跟踪微分器，用于对θ_r做非线性跟踪微分处理，生成跟踪姿态θ_td和跟踪姿态微分ω_td，将跟踪姿态θ_td发送至单神经元分流模块，将跟踪姿态微分ω_td发送至第二控制器；

单神经元分流模块，用于接收外部敏感器传来的外部挠性卫星的姿态角测量值θ，用θ_td减去θ得到姿态误差e，根据所述姿态误差e计算得到快速平滑的姿态误差信号ξ，将ξ发送至第二控制器；

第二控制器，用于接收所述外部敏感器传来的所述外部挠性卫星的角速度测量值ω，用跟踪姿态微分ω_td减去ω得到角速度误差e_ω；对ξ和e_ω依次进行比例、积分、微分处理，生成第一比例积分微分PID控制量，将所述第一PID控制量发送至所述第二结构滤波器；

第二结构滤波器，用于对所述第一PID控制量进二阶滤波处理，生成滤波后第一控制量，发送给外部执行器，以使所述执行器对挠性卫星进行控制；

第一控制器，用于接收所述外部敏感器传来的姿态角测量值θ和角速度测量值ω，用目标姿态角θ_r减去θ得到姿态误差θ_r-θ；角速度误差为-ω；对姿态误差θ_r-θ和角速度误差-ω依次做比例、积分、微分处理，生成第二PID控制量，将所述第二PID控制量发送至所述第一结构滤波器；

第一结构滤波器，用于对第二PID控制量进二阶滤波处理，生成滤波后第二控制量，发送给外部执行器，以使所述执行器对挠性卫星进行控制。

本发明实施例提供一种兼顾机动控制与稳定控制的挠性卫星姿态控制方法，包括如下步骤：

调度逻辑模块接收外部上层模块传来的目标姿态角θ_r和任务类型信息；当判定任务类型为姿态调节控制时，将目标姿态角θ_r发送至第一控制器，并置第二控制器的控制量为0；当判定所述任务类型为姿态机动控制时，则将目标姿态角θ_r发送至跟踪微分器，并置第一控制器的控制量为0；

跟踪微分器对θ_r做非线性跟踪微分处理，生成跟踪姿态θ_td和跟踪姿态微分ω_td，将跟踪姿态θ_td发送至单神经元分流模块，将跟踪姿态微分ω_td发送至第二控制器；

单神经元分流模块接收外部敏感器传来的外部挠性卫星的姿态角测量值θ；用θ_td减去θ得到姿态误差e，根据所述姿态误差e计算得到快速平滑的姿态误差信号ξ，将ξ发送至第二控制器；

第二控制器接收外部敏感器传来的外部挠性卫星的角速度测量值ω，用跟踪姿态微分ω_td减去ω得到角速度误差e_ω；对ξ和e_ω依次进行比例、积分、微分处理，生成第一PID控制量，将第一PID控制量发送至第二结构滤波器；

第二结构滤波器对第一PID控制量进二阶滤波处理，生成滤波后第一控制量，发送给外部执行器，以使所述执行器对挠性卫星进行控制；

第一控制器接收外部敏感器传来的所述姿态角测量值θ和角速度测量值ω；用目标姿态角θ_r减去θ得到姿态误差θ_r-θ；角速度误差为-ω；对姿态误差θ_r-θ和角速度误差-ω依次做比例、积分、微分处理，生成第二PID控制量，将所述第二PID控制量发送至第一结构滤波器；

第一结构滤波器对第二PID控制量进二阶滤波处理，生成滤波后第二控制量，发送给外部执行器，以使所述执行器对挠性卫星进行控制。

本发明与现有技术相比的有益效果是：利用本发明实施例提供的技术方案，调度逻辑模块先判断任务类型是属于姿态调节控制还是属于姿态机动控制。若属于姿态调节控制，则将目标姿态角θ_r发送至第一控制器，使其根据目标姿态角θ_r及外部挠性卫星的姿态角测量值θ和角速度测量值ω进行后续计算得到第二控制量以对挠性卫星进行控制，同时将第二控制器的控制量置为0。同理，若属于姿态机动控制，则将目标姿态角θ_r发送至跟踪微分器，利用第二控制器和第二结构滤波器进行后续计算得到第一控制量，以对挠性卫星进行控制。利用本发明的完整的控制器系统，兼顾了姿态机动控制与姿态稳定控制这两方面的需求。因此在大角度姿态机动时无需额外的机动路径规划，可以直接用目标姿态进行控制，并且在不延长机动时间的前提下改善姿态平稳性。此外，本发明综合控制效果良好，在压缩过渡过程时间和减小姿态超调量两方面可以取得较好的均衡。

附图说明

图1为本发明挠性卫星姿态控制器示意图；

图2为本发明实施例提供的一种兼顾机动控制与稳定控制的挠性卫星姿态控制方法的流程示意图。

具体实施方式

下面结合实施例对本发明作进一步阐述。

针对目前工程上用一种控制结构、两套控制参数来应对姿态机动控制和姿态稳定控制任务时存在的缺点，本发明提出了一种以兼顾姿态机动控制与姿态稳定控制为目标，将非线性跟踪微分器和单神经元分流模块联合使用以实现压缩过渡过程并减小姿态超调量的控制方法。与现有方法相比，本方法在大角度姿态机动时无需额外的机动路径规划，而可以直接用目标姿态进行控制，并且在不延长机动时间的前提下可有效确保姿态的平稳性。

挠性卫星姿态控制器，包括：调度逻辑模块、跟踪微分器、单神经元分流模块、第一控制器、第一结构滤波器、第二控制器和第二结构滤波器；具体如图1所示。

本发明虽然设计了2个结构相同的控制器，都采用PID控制律+结构滤波器的形式。但两套控制器的具体参数不同。第一控制器用于执行常规的姿态调节控制任务，按照低带宽原则进行参数设计。第二控制器用于执行姿态机动控制任务，按照高带宽原则进行参数设计。

调度逻辑模块，用于接收外部上层模块传来的目标姿态角θ_r和任务类型信息；当判定任务类型为姿态调节控制时，将目标姿态角θ_r发送至第一控制器，并置第二控制器的控制量为0，当判定所述任务类型为姿态机动控制时，则将目标姿态角θ_r发送至跟踪微分器，并置第一控制器的控制量为0；

跟踪微分器，用于对θ_r做非线性跟踪微分处理，生成跟踪姿态θ_td和跟踪姿态微分ω_td，将跟踪姿态θ_td发送至单神经元分流模块，将跟踪姿态微分ω_td发送至第二控制器。跟踪微分器的非线性离散方程为：

式中，θ_r为系统设定值；

θ_td为输出的预设姿态；

h为离散计算步长；

ω_td为预设姿态θ_td的微分；

e_r(k)输入误差；

r为过渡过程的时间尺度；

h₀为计算步长；

f_TD(x₁,x₂,r,h₀)为非线性函数；f_TD(x₁,x₂,r,h₀)的表达式为：

式中，a为临时变量。

尽管跟踪微分器给出的预设姿态是平滑的，但反馈的输出信号仍然可能有较大波动并可能激发挠性模态的振动，为此设计单神经元分流模块环节，用于对姿态误差信号进一步快速平滑。

神经元分流模型是一种简化的生物神经元动力学模型，具有结构简单、计算量小、模型稳定、输出光滑且有界、增益自调整等特点，将其引入姿态误差信号的自适应平滑处理中是很合适的。

单神经元分流模块，用于接收外部敏感器传来的外部挠性卫星的姿态角测量值θ，用θ_td减去θ得到姿态误差e，根据所述姿态误差e计算得到快速平滑的姿态误差信号ξ，将ξ发送至第二控制器。单神经元分流模块的计算公式为：

e(k)＝θ_td(k)-θ(k)

ξ(k+1)＝ξ(k)+h{-Aξ(k)+[B-ξ(k)]S_e(e(k))-[D+ξ(k)]S_i(e(k))}

式中，e(k)为姿态控制误差；

θ_td为输出的预设姿态；

θ(k)为当前姿态角测量值；

h为离散计算步长；

A为衰减率；

B为输出信号的上界；

D为输出信号的下界；

S_e(e(k))为兴奋输入；S_e(e(k))的计算方法为：

S_e(e(k))＝max{e(k),0}

S_i(e(k))为抑制输入；S_i(e(k))的计算方法为：

S_i(e(k))＝max{-e(k),0}。

ξ(k)为模型输出。

第二控制器，用于接收所述外部敏感器传来的所述外部挠性卫星的角速度测量值ω，用跟踪姿态微分ω_td减去ω得到角速度误差e_ω；对ξ和e_ω依次进行比例、积分、微分处理，生成第一比例积分微分PID控制量，将所述第一PID控制量发送至所述第二结构滤波器。

第二结构滤波器，用于对所述第一PID控制量进二阶滤波处理，生成滤波后第一控制量，发送给外部执行器，以使所述执行器对挠性卫星进行控制。

第一控制器，用于接收所述外部敏感器传来的姿态角测量值θ和角速度测量值ω，用目标姿态角θ_r减去θ得到姿态误差θ_r-θ；角速度误差为-ω；对姿态误差θ_r-θ和角速度误差-ω依次做比例、积分、微分处理，生成第二PID控制量，将所述第二PID控制量发送至所述第一结构滤波器。第一控制器和第二控制器均采用PID控制律+结构滤波器形式；其中，PID控制律u_PID(k)的计算方法为：

式中，k为当前时刻的时间序列序号；

e(k)为姿态控制误差；

e_d(k)为角速度控制误差；

K_p为第一控制参数；

K_i为第二控制参数；

K_d为第三控制参数；

所述第一控制器和第二控制器均采用二阶滤波器结构，传递函数为：

式中，s拉普拉斯算子；

ω_z为滤波器零点的角频率；

ω_p为滤波器极点的角频率；

ζ_z滤波器零点的阻尼比；

ζ_p为滤波器极点的阻尼比。

第一结构滤波器，用于对第二PID控制量进二阶滤波处理，生成滤波后第二控制量，发送给外部执行器，以使所述执行器对挠性卫星进行控制。

在本发明一实施例中，该姿态控制器与外部敏感器进行交互。该外部敏感期实现对外部挠性卫星姿态角和角速度的测量，获得姿态角测量值θ和角速度测量值ω并发送给姿态控制器。

本发明设计了可动态切换的两套控制律，由调度逻辑进行自动切换；设计离散型非线性跟踪微分器在线安排过渡过程，以解决快速性与超调之间的矛盾；设计单神经元分流模块环节，利用其控制增益的在线自动调整能力实现对姿态误差信号进一步快速平滑，从而达到压缩过渡过程时间的同时减小姿态超调量的目标。

图2为本发明实施例提供的一种兼顾机动控制与稳定控制的挠性卫星姿态控制方法的流程示意图。如图2所示，该方法具体包括如下步骤：

步骤201，调度逻辑模块接收外部上层模块传来的目标姿态角θ_r和任务类型信息；当判定任务类型为姿态调节控制时，将目标姿态角θ_r发送至第一控制器，并置第二控制器的控制量为0，执行步骤206；当判定所述任务类型为姿态机动控制时，则将目标姿态角θ_r发送至跟踪微分器，并置第一控制器的控制量为0，执行步骤202。第一控制器和第二控制器均采用PID控制律+结构滤波器形式；其中，PID控制律u_PID(k)的计算方法为：

式中，k为当前时刻的时间序列序号；

e(k)为姿态控制误差；

e_d(k)为角速度控制误差；

K_p为第一控制参数；

K_i为第二控制参数；

K_d为第三控制参数；

第一控制器和第二控制器均采用二阶滤波器结构，传递函数为：

式中，s拉普拉斯算子；

ω_z为滤波器零点的角频率；

ω_p为滤波器极点的角频率；

ζ_z滤波器零点的阻尼比；

ζ_p为滤波器极点的阻尼比。

步骤202，跟踪微分器对θ_r做非线性跟踪微分处理，生成跟踪姿态θ_td和跟踪姿态微分ω_td，将跟踪姿态θ_td发送至单神经元分流模块，将跟踪姿态微分ω_td发送至第二控制器。

步骤203，单神经元分流模块接收外部敏感器传来的外部挠性卫星的姿态角测量值θ；用θ_td减去θ得到姿态误差e，根据所述姿态误差e计算得到快速平滑的姿态误差信号ξ，将ξ发送至第二控制器。跟踪微分器的非线性离散方程为：

式中，θ_r为系统设定值；

θ_td为输出的预设姿态；

h为离散计算步长；

ω_td为预设姿态θ_td的微分；

e_r(k)输入误差；

r为过渡过程的时间尺度；

h₀为计算步长；

f_TD(x₁,x₂,r,h₀)为非线性函数；

非线性函数f_TD(x₁,x₂,r,h₀)的表达式为：

式中，a为临时变量；

所述单神经元分流模块的计算公式为：

e(k)＝θ_td(k)-θ(k)

ξ(k+1)＝ξ(k)+h{-Aξ(k)+[B-ξ(k)]S_e(e(k))-[D+ξ(k)]S_i(e(k))}

式中，e(k)为姿态控制误差；

θ_td为输出的预设姿态；

θ(k)为当前姿态角测量值；

h为离散计算步长；

A为衰减率；

B为输出信号的上界；

D为输出信号的下界；

S_e(e(k))为兴奋输入；S_e(e(k))＝max{e(k),0}；

S_i(e(k))为抑制输入；S_i(e(k))＝max{-e(k),0}；

ξ(k)为模型输出。

步骤204，第二控制器接收外部敏感器传来的外部挠性卫星的角速度测量值ω，用跟踪姿态微分ω_td减去ω得到角速度误差e_ω；对ξ和e_ω依次进行比例、积分、微分处理，生成第一PID控制量，将第一PID控制量发送至第二结构滤波器。

步骤205，第二结构滤波器对第一PID控制量进二阶滤波处理，生成滤波后第一控制量，发送给外部执行器，以使所述执行器对挠性卫星进行控制。

步骤206，第一控制器接收外部敏感器传来的所述姿态角测量值θ和角速度测量值ω；用目标姿态角θ_r减去θ得到姿态误差θ_r-θ；角速度误差为-ω；对姿态误差θ_r-θ和角速度误差-ω依次做比例、积分、微分处理，生成第二PID控制量，将所述第二PID控制量发送至第一结构滤波器。

步骤哦207，第一结构滤波器对第二PID控制量进二阶滤波处理，生成滤波后第二控制量，发送给外部执行器，以使所述执行器对挠性卫星进行控制。

在本发明一实施例中，以滚动轴为例进行阐述。假设卫星滚动轴惯量为5000kg·m²，正常工作模式，姿态调节时用飞轮执行姿态控制任务(飞轮最大力矩0.1Nm)，姿态机动时用喷气推力器执行机动任务(产生的最大控制力矩为40Nm)，最大目标角速度为0.5°/s，非姿态机动期间的最大角速度指标为0.005°/s，采样周期h＝0.1s。

(1)设计两套结构相同、参数不同的“PID控制律+结构滤波器”，作为整个控制器的主体

按如下公式计算PID控制律：

对于控制器1，可取K_p＝30、K_i＝0.3、K_d＝40。对于控制器2，可取K_p＝45、K_i＝0.4、K_d＝70。

按如下形式实现结构滤波器：

对于多数挠性卫星，可以按照带阻滤波器进行设计，重点考虑一阶挠性模态。例如，若一阶挠性模态频率为0.628rad/s(约0.1Hz),则对于控制器1，可取ω_z＝ω_p＝0.7，ζ_z＝0.05、ζ_p＝0.4；对于控制器2，可取ω_z＝ω_p＝0.7，ζ_z＝0.04、ζ_p＝0.8。

(2)设计调度逻辑，对两套控制器进行在线切换

当执行常规的姿态调节控制时，采用控制器1；当执行姿态机动控制时，采用控制器2。

(3)在控制器2前设计跟踪微分器和单神经元分流模块两个环节具体设计见下述要点(4)(5)。

(4)设计跟踪微分器以在线安排过渡过程

计算公式如下：

相关设计参数取值如下：速度因子r＝5，时间参数h₀＝1(即10h)。

(5)设计单神经元分流模块环节以对姿态误差信号进一步快速平滑计算公式如下：

e(k)＝θ_td(k)-θ(k)

ξ(k+1)＝ξ(k)+h{-Aξ(k)+[B-ξ(k)]S_e(e(k))-[D+ξ(k)]S_i(e(k))}

S_e(e)＝max{e,0}

S_i(e)＝max{-e,0}

相关设计参数取值如下：衰减率A为＝5，输出信号上下界B＝D＝8。

本发明虽然已以较佳实施例公开如上，但其并不是用来限定本发明，任何本领域技术人员在不脱离本发明的精神和范围内，都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改，因此，凡是未脱离本发明技术方案的内容，依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰，均属于本发明技术方案的保护范围。

Claims (10)

1.兼顾机动控制与稳定控制的挠性卫星姿态控制器，其特征在于，包括：

调度逻辑模块，用于接收外部上层模块传来的目标姿态角θ_r和任务类型信息；当判定任务类型为姿态调节控制时，将目标姿态角θ_r发送至第一控制器，并置第二控制器的控制量为0，当判定所述任务类型为姿态机动控制时，则将目标姿态角θ_r发送至跟踪微分器，并置第一控制器的控制量为0；

跟踪微分器，用于对θ_r做非线性跟踪微分处理，生成跟踪姿态θ_td和跟踪姿态微分ω_td，将跟踪姿态θ_td发送至单神经元分流模块，将跟踪姿态微分ω_td发送至第二控制器；

单神经元分流模块，用于接收外部敏感器传来的外部挠性卫星的姿态角测量值θ，用θ_td减去θ得到姿态误差e，根据所述姿态误差e计算得到快速平滑的姿态误差信号ξ，将ξ发送至第二控制器；

第二控制器，用于接收所述外部敏感器传来的所述外部挠性卫星的角速度测量值ω，用跟踪姿态微分ω_td减去ω得到角速度误差e_ω；对ξ和e_ω依次进行比例、积分、微分处理，生成第一比例积分微分PID控制量，将所述第一PID控制量发送至第二结构滤波器；

第二结构滤波器，用于对所述第一PID控制量进二阶滤波处理，生成滤波后第一控制量，发送给外部执行器，以使所述执行器对挠性卫星进行控制；

第一控制器，用于接收所述外部敏感器传来的姿态角测量值θ和角速度测量值ω，用目标姿态角θ_r减去θ得到姿态误差θ_r-θ；角速度误差为-ω；对姿态误差θ_r-θ和角速度误差-ω依次做比例、积分、微分处理，生成第二PID控制量，将所述第二PID控制量发送至第一结构滤波器；

第一结构滤波器，用于对第二PID控制量进二阶滤波处理，生成滤波后第二控制量，发送给外部执行器，以使所述执行器对挠性卫星进行控制。

2.根据权利要求1所述的控制器，其特征在于，所述第一控制器和第二控制器均采用PID控制律加结构滤波器的形式；其中，PID控制律u_PID(k)的计算方法包括：

式中，k为当前时刻的时间序列序号；

e(k)为姿态控制误差；

e_d(k)为角速度控制误差；

K_p为第一控制参数；

K_i为第二控制参数；

K_d为第三控制参数。

3.根据权利要求2所述的控制器，其特征在于，所述第一控制器和第二控制器均采用二阶滤波器结构，传递函数为：

式中，s为拉普拉斯算子；

ω_z为滤波器零点的角频率；

ω_p为滤波器极点的角频率；

ζ_z为滤波器零点的阻尼比；

ζ_p为滤波器极点的阻尼比。

4.根据权利要求1所述的控制器，其特征在于：所述跟踪微分器的非线性离散方程为：

式中，θ_r为系统设定值；

θ_td为输出的预设姿态；

h为离散计算步长；

ω_td为预设姿态θ_td的微分；

e_r(k)输入误差；

r为过渡过程的时间尺度；

h₀为计算步长；

f_TD(x₁,x₂,r,h₀)为非线性函数。

5.根据权利要求4所述的控制器，其特征在于，所述非线性函数f_TD(x₁,x₂,r,h₀)的表达式为：

式中，a为临时变量。

6.根据权利要求1所述的控制器，其特征在于，所述单神经元分流模块的计算公式为：

e(k)＝θ_td(k)-θ(k)

ξ(k+1)＝ξ(k)+h{-Aξ(k)+[B-ξ(k)]S_e(e(k))-[D+ξ(k)]S_i(e(k))}

式中，e(k)为姿态控制误差；

θ_td为输出的预设姿态；

θ(k)为当前姿态角测量值；

h为离散计算步长；

A为衰减率；

B为输出信号的上界；

D为输出信号的下界；

S_e(e(k))为兴奋输入；

S_i(e(k))为抑制输入；

ξ(k)为模型输出。

7.根据权利要求6所述的控制器，其特征在于，所述兴奋输入S_e(e(k))的计算方法为：

S_e(e(k))＝max{e(k),0}

所述抑制输入S_i(e(k))的计算方法为：

S_i(e(k))＝max{-e(k),0}。

8.一种兼顾机动控制与稳定控制的挠性卫星姿态控制方法，其特征在于，包括如下步骤：

调度逻辑模块接收外部上层模块传来的目标姿态角θ_r和任务类型信息；当判定任务类型为姿态调节控制时，将目标姿态角θ_r发送至第一控制器，并置第二控制器的控制量为0；当判定所述任务类型为姿态机动控制时，则将目标姿态角θ_r发送至跟踪微分器，并置第一控制器的控制量为0；

跟踪微分器对θ_r做非线性跟踪微分处理，生成跟踪姿态θ_td和跟踪姿态微分ω_td，将跟踪姿态θ_td发送至单神经元分流模块，将跟踪姿态微分ω_td发送至第二控制器；

单神经元分流模块接收外部敏感器传来的外部挠性卫星的姿态角测量值θ；用θ_td减去θ得到姿态误差e，根据所述姿态误差e计算得到快速平滑的姿态误差信号ξ，将ξ发送至第二控制器；

第二控制器接收外部敏感器传来的外部挠性卫星的角速度测量值ω，用跟踪姿态微分ω_td减去ω得到角速度误差e_ω；对ξ和e_ω依次进行比例、积分、微分处理，生成第一PID控制量，将第一PID控制量发送至第二结构滤波器；

第二结构滤波器对第一PID控制量进二阶滤波处理，生成滤波后第一控制量，发送给外部执行器，以使所述执行器对挠性卫星进行控制；

第一控制器接收外部敏感器传来的所述姿态角测量值θ和角速度测量值ω；用目标姿态角θ_r减去θ得到姿态误差θ_r-θ；角速度误差为-ω；对姿态误差θ_r-θ和角速度误差-ω依次做比例、积分、微分处理，生成第二PID控制量，将所述第二PID控制量发送至第一结构滤波器；

第一结构滤波器对第二PID控制量进二阶滤波处理，生成滤波后第二控制量，发送给外部执行器，以使所述执行器对挠性卫星进行控制。

9.根据权利要求8所述的方法，其特征在于，所述第一控制器和第二控制器均采用PID控制律加结构滤波器形式；其中，PID控制律u_PID(k)的计算方法为：

式中，k为当前时刻的时间序列序号；

e(k)为姿态控制误差；

e_d(k)为角速度控制误差；

K_p为第一控制参数；

K_i为第二控制参数；

K_d为第三控制参数；

第一控制器和第二控制器均采用二阶滤波器结构，传递函数为：

式中，s为拉普拉斯算子；

ω_z为滤波器零点的角频率；

ω_p为滤波器极点的角频率；

ζ_z为滤波器零点的阻尼比；

ζ_p为滤波器极点的阻尼比。

10.根据权利要求8所述的方法，其特征在于，所述跟踪微分器的非线性离散方程为：

式中，θ_r为系统设定值；

θ_td为输出的预设姿态；

h为离散计算步长；

ω_td为预设姿态θ_td的微分；

e_r(k)输入误差；

r为过渡过程的时间尺度；

h₀为计算步长；

f_TD(x₁,x₂,r,h₀)为非线性函数；

非线性函数f_TD(x₁,x₂,r,h₀)的表达式为：

式中，a为临时变量；

所述单神经元分流模块的计算公式为：

e(k)＝θ_td(k)-θ(k)

ξ(k+1)＝ξ(k)+h{-Aξ(k)+[B-ξ(k)]S_e(e(k))-[D+ξ(k)]S_i(e(k))}

式中，e(k)为姿态控制误差；

θ_td为输出的预设姿态；

θ(k)为当前姿态角测量值；

h为离散计算步长；

A为衰减率；

B为输出信号的上界；

D为输出信号的下界；

S_e(e(k))为兴奋输入；S_e(e(k))＝max{e(k),0}；

S_i(e(k))为抑制输入；S_i(e(k))＝max{-e(k),0}；

ξ(k)为模型输出。

Images