CN113568421A - 兼顾机动控制与稳定控制的挠性卫星姿态控制器及方法 - Google Patents
兼顾机动控制与稳定控制的挠性卫星姿态控制器及方法 Download PDFInfo
- Publication number
- CN113568421A CN113568421A CN202110672043.4A CN202110672043A CN113568421A CN 113568421 A CN113568421 A CN 113568421A CN 202110672043 A CN202110672043 A CN 202110672043A CN 113568421 A CN113568421 A CN 113568421A
- Authority
- CN
- China
- Prior art keywords
- attitude
- control
- theta
- controller
- error
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 31
- 210000002569 neuron Anatomy 0.000 claims abstract description 27
- 230000007704 transition Effects 0.000 claims abstract description 10
- 238000005259 measurement Methods 0.000 claims description 36
- 238000012545 processing Methods 0.000 claims description 31
- 238000004364 calculation method Methods 0.000 claims description 23
- 238000001914 filtration Methods 0.000 claims description 20
- 238000013016 damping Methods 0.000 claims description 8
- 238000012886 linear function Methods 0.000 claims description 5
- 230000002964 excitative effect Effects 0.000 claims description 4
- 238000012546 transfer Methods 0.000 claims description 4
- 230000005284 excitation Effects 0.000 claims 1
- 230000001629 suppression Effects 0.000 claims 1
- 230000006641 stabilisation Effects 0.000 abstract description 3
- 238000011105 stabilization Methods 0.000 abstract description 3
- 230000006835 compression Effects 0.000 abstract description 2
- 238000007906 compression Methods 0.000 abstract description 2
- 238000013461 design Methods 0.000 description 7
- 238000009499 grossing Methods 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000033228 biological regulation Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0833—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using limited authority control
Landscapes
- Engineering & Computer Science (AREA)
- Computer Security & Cryptography (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
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的微分;
er(k)输入误差;
r为过渡过程的时间尺度;
h0为计算步长;
f_TD(x1,x2,r,h0)为非线性函数;f_TD(x1,x2,r,h0)的表达式为:
式中,a为临时变量。
尽管跟踪微分器给出的预设姿态是平滑的,但反馈的输出信号仍然可能有较 大波动并可能激发挠性模态的振动,为此设计单神经元分流模块环节,用于对 姿态误差信号进一步快速平滑。
神经元分流模型是一种简化的生物神经元动力学模型,具有结构简单、计 算量小、模型稳定、输出光滑且有界、增益自调整等特点,将其引入姿态误差 信号的自适应平滑处理中是很合适的。
单神经元分流模块,用于接收外部敏感器传来的外部挠性卫星的姿态角测 量值θ,用θtd减去θ得到姿态误差e,根据所述姿态误差e计算得到快速平滑的 姿态误差信号ξ,将ξ发送至第二控制器。单神经元分流模块的计算公式为:
e(k)=θtd(k)-θ(k)
ξ(k+1)=ξ(k)+h{-Aξ(k)+[B-ξ(k)]Se(e(k))-[D+ξ(k)]Si(e(k))}
式中,e(k)为姿态控制误差;
θtd为输出的预设姿态;
θ(k)为当前姿态角测量值;
h为离散计算步长;
A为衰减率;
B为输出信号的上界;
D为输出信号的下界;
Se(e(k))为兴奋输入;Se(e(k))的计算方法为:
Se(e(k))=max{e(k),0}
Si(e(k))为抑制输入;Si(e(k))的计算方法为:
Si(e(k))=max{-e(k),0}。
ξ(k)为模型输出。
第二控制器,用于接收所述外部敏感器传来的所述外部挠性卫星的角速度 测量值ω,用跟踪姿态微分ωtd减去ω得到角速度误差eω;对ξ和eω依次进行比 例、积分、微分处理,生成第一比例积分微分PID控制量,将所述第一PID控 制量发送至所述第二结构滤波器。
第二结构滤波器,用于对所述第一PID控制量进二阶滤波处理,生成滤波 后第一控制量,发送给外部执行器,以使所述执行器对挠性卫星进行控制。
第一控制器,用于接收所述外部敏感器传来的姿态角测量值θ和角速度测 量值ω,用目标姿态角θr减去θ得到姿态误差θr-θ;角速度误差为-ω;对姿态 误差θr-θ和角速度误差-ω依次做比例、积分、微分处理,生成第二PID控制量, 将所述第二PID控制量发送至所述第一结构滤波器。第一控制器和第二控制器 均采用PID控制律+结构滤波器形式;其中,PID控制律uPID(k)的计算方法为:
式中,k为当前时刻的时间序列序号;
e(k)为姿态控制误差;
ed(k)为角速度控制误差;
Kp为第一控制参数;
Ki为第二控制参数;
Kd为第三控制参数;
所述第一控制器和第二控制器均采用二阶滤波器结构,传递函数为:
式中,s拉普拉斯算子;
ωz为滤波器零点的角频率;
ωp为滤波器极点的角频率;
ζz滤波器零点的阻尼比;
ζp为滤波器极点的阻尼比。
第一结构滤波器,用于对第二PID控制量进二阶滤波处理,生成滤波后第 二控制量,发送给外部执行器,以使所述执行器对挠性卫星进行控制。
在本发明一实施例中,该姿态控制器与外部敏感器进行交互。该外部敏感 期实现对外部挠性卫星姿态角和角速度的测量,获得姿态角测量值θ和角速度 测量值ω并发送给姿态控制器。
本发明设计了可动态切换的两套控制律,由调度逻辑进行自动切换;设计 离散型非线性跟踪微分器在线安排过渡过程,以解决快速性与超调之间的矛盾; 设计单神经元分流模块环节,利用其控制增益的在线自动调整能力实现对姿态 误差信号进一步快速平滑,从而达到压缩过渡过程时间的同时减小姿态超调量 的目标。
图2为本发明实施例提供的一种兼顾机动控制与稳定控制的挠性卫星姿态 控制方法的流程示意图。如图2所示,该方法具体包括如下步骤:
步骤201,调度逻辑模块接收外部上层模块传来的目标姿态角θr和任务类 型信息;当判定任务类型为姿态调节控制时,将目标姿态角θr发送至第一控制 器,并置第二控制器的控制量为0,执行步骤206;当判定所述任务类型为姿 态机动控制时,则将目标姿态角θr发送至跟踪微分器,并置第一控制器的控制 量为0,执行步骤202。第一控制器和第二控制器均采用PID控制律+结构滤波 器形式;其中,PID控制律uPID(k)的计算方法为:
式中,k为当前时刻的时间序列序号;
e(k)为姿态控制误差;
ed(k)为角速度控制误差;
Kp为第一控制参数;
Ki为第二控制参数;
Kd为第三控制参数;
第一控制器和第二控制器均采用二阶滤波器结构,传递函数为:
式中,s拉普拉斯算子;
ωz为滤波器零点的角频率;
ωp为滤波器极点的角频率;
ζz滤波器零点的阻尼比;
ζp为滤波器极点的阻尼比。
步骤202,跟踪微分器对θr做非线性跟踪微分处理,生成跟踪姿态θtd和跟 踪姿态微分ωtd,将跟踪姿态θtd发送至单神经元分流模块,将跟踪姿态微分ωtd发 送至第二控制器。
步骤203,单神经元分流模块接收外部敏感器传来的外部挠性卫星的姿态 角测量值θ;用θtd减去θ得到姿态误差e,根据所述姿态误差e计算得到快速平 滑的姿态误差信号ξ,将ξ发送至第二控制器。跟踪微分器的非线性离散方程为:
式中,θr为系统设定值;
θtd为输出的预设姿态;
h为离散计算步长;
ωtd为预设姿态θtd的微分;
er(k)输入误差;
r为过渡过程的时间尺度;
h0为计算步长;
f_TD(x1,x2,r,h0)为非线性函数;
非线性函数f_TD(x1,x2,r,h0)的表达式为:
式中,a为临时变量;
所述单神经元分流模块的计算公式为:
e(k)=θtd(k)-θ(k)
ξ(k+1)=ξ(k)+h{-Aξ(k)+[B-ξ(k)]Se(e(k))-[D+ξ(k)]Si(e(k))}
式中,e(k)为姿态控制误差;
θtd为输出的预设姿态;
θ(k)为当前姿态角测量值;
h为离散计算步长;
A为衰减率;
B为输出信号的上界;
D为输出信号的下界;
Se(e(k))为兴奋输入;Se(e(k))=max{e(k),0};
Si(e(k))为抑制输入;Si(e(k))=max{-e(k),0};
ξ(k)为模型输出。
步骤204,第二控制器接收外部敏感器传来的外部挠性卫星的角速度测量 值ω,用跟踪姿态微分ωtd减去ω得到角速度误差eω;对ξ和eω依次进行比例、 积分、微分处理,生成第一PID控制量,将第一PID控制量发送至第二结构滤 波器。
步骤205,第二结构滤波器对第一PID控制量进二阶滤波处理,生成滤波 后第一控制量,发送给外部执行器,以使所述执行器对挠性卫星进行控制。
步骤206,第一控制器接收外部敏感器传来的所述姿态角测量值θ和角速度 测量值ω;用目标姿态角θr减去θ得到姿态误差θr-θ;角速度误差为-ω;对姿 态误差θr-θ和角速度误差-ω依次做比例、积分、微分处理,生成第二PID控制 量,将所述第二PID控制量发送至第一结构滤波器。
步骤哦207,第一结构滤波器对第二PID控制量进二阶滤波处理,生成滤 波后第二控制量,发送给外部执行器,以使所述执行器对挠性卫星进行控制。
在本发明一实施例中,以滚动轴为例进行阐述。假设卫星滚动轴惯量为 5000kg·m2,正常工作模式,姿态调节时用飞轮执行姿态控制任务(飞轮最大 力矩0.1Nm),姿态机动时用喷气推力器执行机动任务(产生的最大控制力矩 为40Nm),最大目标角速度为0.5°/s,非姿态机动期间的最大角速度指标为 0.005°/s,采样周期h=0.1s。
(1)设计两套结构相同、参数不同的“PID控制律+结构滤波器”,作为整 个控制器的主体
按如下公式计算PID控制律:
对于控制器1,可取Kp=30、Ki=0.3、Kd=40。对于控制器2,可取Kp=45、 Ki=0.4、Kd=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,时间参数h0=1(即10h)。
(5)设计单神经元分流模块环节以对姿态误差信号进一步快速平滑 计算公式如下:
e(k)=θtd(k)-θ(k)
ξ(k+1)=ξ(k)+h{-Aξ(k)+[B-ξ(k)]Se(e(k))-[D+ξ(k)]Si(e(k))}
Se(e)=max{e,0}
Si(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控制量进二阶滤波处理,生成滤波后第二控制量,发送给外部执行器,以使所述执行器对挠性卫星进行控制。
6.根据权利要求1所述的控制器,其特征在于,所述单神经元分流模块的计算公式为:
e(k)=θtd(k)-θ(k)
ξ(k+1)=ξ(k)+h{-Aξ(k)+[B-ξ(k)]Se(e(k))-[D+ξ(k)]Si(e(k))}
式中,e(k)为姿态控制误差;
θtd为输出的预设姿态;
θ(k)为当前姿态角测量值;
h为离散计算步长;
A为衰减率;
B为输出信号的上界;
D为输出信号的下界;
Se(e(k))为兴奋输入;
Si(e(k))为抑制输入;
ξ(k)为模型输出。
7.根据权利要求6所述的控制器,其特征在于,所述兴奋输入Se(e(k))的计算方法为:
Se(e(k))=max{e(k),0}
所述抑制输入Si(e(k))的计算方法为:
Si(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控制量进二阶滤波处理,生成滤波后第二控制量,发送给外部执行器,以使所述执行器对挠性卫星进行控制。
10.根据权利要求8所述的方法,其特征在于,所述跟踪微分器的非线性离散方程为:
式中,θr为系统设定值;
θtd为输出的预设姿态;
h为离散计算步长;
ωtd为预设姿态θtd的微分;
er(k)输入误差;
r为过渡过程的时间尺度;
h0为计算步长;
f_TD(x1,x2,r,h0)为非线性函数;
非线性函数f_TD(x1,x2,r,h0)的表达式为:
式中,a为临时变量;
所述单神经元分流模块的计算公式为:
e(k)=θtd(k)-θ(k)
ξ(k+1)=ξ(k)+h{-Aξ(k)+[B-ξ(k)]Se(e(k))-[D+ξ(k)]Si(e(k))}
式中,e(k)为姿态控制误差;
θtd为输出的预设姿态;
θ(k)为当前姿态角测量值;
h为离散计算步长;
A为衰减率;
B为输出信号的上界;
D为输出信号的下界;
Se(e(k))为兴奋输入;Se(e(k))=max{e(k),0};
Si(e(k))为抑制输入;Si(e(k))=max{-e(k),0};
ξ(k)为模型输出。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110672043.4A CN113568421B (zh) | 2021-06-17 | 2021-06-17 | 兼顾机动控制与稳定控制的挠性卫星姿态控制器及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110672043.4A CN113568421B (zh) | 2021-06-17 | 2021-06-17 | 兼顾机动控制与稳定控制的挠性卫星姿态控制器及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113568421A true CN113568421A (zh) | 2021-10-29 |
CN113568421B CN113568421B (zh) | 2023-06-30 |
Family
ID=78162350
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110672043.4A Active CN113568421B (zh) | 2021-06-17 | 2021-06-17 | 兼顾机动控制与稳定控制的挠性卫星姿态控制器及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113568421B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08188199A (ja) * | 1995-01-13 | 1996-07-23 | Nec Corp | 人工衛星の3軸姿勢制御装置 |
JP2002255098A (ja) * | 2001-03-01 | 2002-09-11 | Nec Corp | 人工衛星のマヌーバ制御装置 |
CN103941739A (zh) * | 2014-04-15 | 2014-07-23 | 北京控制工程研究所 | 一种基于多项式的卫星姿态机动方法 |
CN107479566A (zh) * | 2017-08-25 | 2017-12-15 | 中国科学院长春光学精密机械与物理研究所 | 基于三段式路径规划的挠性卫星姿态控制方法 |
CN109270946A (zh) * | 2018-11-13 | 2019-01-25 | 北京航空航天大学 | 挠性航天器的姿态控制方法 |
CN111026142A (zh) * | 2019-12-11 | 2020-04-17 | 北京控制工程研究所 | 一种大干扰和小惯量情况下的快速姿态机动方法及系统 |
CN112115545A (zh) * | 2020-08-11 | 2020-12-22 | 北京航空航天大学 | 一种基于二项式近似模型的挠性卫星姿态机动控制方法 |
-
2021
- 2021-06-17 CN CN202110672043.4A patent/CN113568421B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08188199A (ja) * | 1995-01-13 | 1996-07-23 | Nec Corp | 人工衛星の3軸姿勢制御装置 |
JP2002255098A (ja) * | 2001-03-01 | 2002-09-11 | Nec Corp | 人工衛星のマヌーバ制御装置 |
CN103941739A (zh) * | 2014-04-15 | 2014-07-23 | 北京控制工程研究所 | 一种基于多项式的卫星姿态机动方法 |
CN107479566A (zh) * | 2017-08-25 | 2017-12-15 | 中国科学院长春光学精密机械与物理研究所 | 基于三段式路径规划的挠性卫星姿态控制方法 |
CN109270946A (zh) * | 2018-11-13 | 2019-01-25 | 北京航空航天大学 | 挠性航天器的姿态控制方法 |
CN111026142A (zh) * | 2019-12-11 | 2020-04-17 | 北京控制工程研究所 | 一种大干扰和小惯量情况下的快速姿态机动方法及系统 |
CN112115545A (zh) * | 2020-08-11 | 2020-12-22 | 北京航空航天大学 | 一种基于二项式近似模型的挠性卫星姿态机动控制方法 |
Non-Patent Citations (1)
Title |
---|
钟超;吴敬玉;陆智俊: "基于PD控制的大挠性卫星输入成型姿态机动方法研究", 上海航天, no. 002, pages 85 - 98 * |
Also Published As
Publication number | Publication date |
---|---|
CN113568421B (zh) | 2023-06-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108646758B (zh) | 一种多移动机器人预设性能编队控制器结构及设计方法 | |
Ghadiri et al. | Adaptive super-twisting non-singular terminal sliding mode control for tracking of quadrotor with bounded disturbances | |
CN112817231B (zh) | 一种具有强鲁棒性的机械臂高精度跟踪控制方法 | |
CN106444799B (zh) | 基于模糊扩张状态观测器和自适应滑模的四旋翼无人机控制方法 | |
CN106774273B (zh) | 针对变时滞控制系统执行器故障的滑模预测容错控制方法 | |
CN110221541B (zh) | 伺服系统中前馈控制器的前馈系数获取装置、方法 | |
CN110784149B (zh) | 交流伺服系统机械谐振抑制方法以及系统 | |
CN112720482B (zh) | 一种工业机器人运动控制方法 | |
CN111496796B (zh) | 基于指令滤波器的机械臂轨迹跟踪控制方法及装置 | |
CN106950999B (zh) | 一种采用自抗扰控制技术的移动舞台轨迹跟踪控制方法 | |
US20200073343A1 (en) | Machine learning device, control system, and machine learning method | |
CN107490958A (zh) | 一种五自由度混联机器人的模糊自适应控制方法 | |
CN114839880A (zh) | 一种基于柔性关节机械臂的自适应控制方法 | |
Yang et al. | Command-filter-based backstepping control for flexible joint manipulator systems with full-state constrains | |
Li et al. | Adaptive optimal trajectory tracking control of AUVs based on reinforcement learning | |
CN113467340A (zh) | 改进的一阶线性自抗扰控制系统及其参数整定方法 | |
CN114019997A (zh) | 固定翼无人机位置跟踪偏差约束下有限时间控制方法 | |
CN116880535A (zh) | 一种改进二阶自抗扰控制四旋翼无人机的姿态控制方法 | |
CN111152213B (zh) | 一种基于混合控制的机械臂振动补偿方法及装置 | |
US11243501B2 (en) | Machine learning device, control system, and machine learning | |
CN110701187B (zh) | 一种五自由度磁轴承的智能双积分滑模控制方法及设备 | |
CN113568421A (zh) | 兼顾机动控制与稳定控制的挠性卫星姿态控制器及方法 | |
CN114839882B (zh) | 一种输入约束下的非线性系统复合自适应控制方法 | |
Sharkawy et al. | A robust fuzzy tracking control scheme for robotic manipulators with experimental verification | |
Zhu et al. | A PID based approximation-free controller with prescribed performance function for model helicopter attitude control |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |