[发明专利]一种飞行器姿态角控制方法、控制装置及存储介质

说明书

本申请实施例中提供了一种飞行器姿态角控制方法、控制装置及存储介质。飞行器姿态角控制方法通过根据目标点的地心系坐标以及飞行器的地心系坐标计算飞行器‑目标矢量的地心系投影；再根据飞行器‑目标矢量的地心系投影得到飞行器‑目标矢量的发射惯性系投影；然后根据飞行器‑目标矢量的发射惯性系投影进行归一化得到飞行器姿态角指令输入参数；最后根据飞行器姿态角指令输入参数得到飞行器姿态角指令控制飞行器姿态角。实现了使其飞行器X、Y及Z某一轴线或任意轴线指向地面固定位置时进行飞行器姿态角度约束控制，解决了目前还未出现飞行器姿态调整使飞行器某一轴线定向的问题。

技术领域

本申请属于航空航天技术领域，具体地，涉及一种飞行器姿态角控制方法、 控制装置及存储介质。

背景技术

在固体运载火箭制导设计中，固体运载火箭在卫星释放时刻需要满足特定 的姿态角度约束，使其箭体某一轴线或任意轴线指向地面固定纬度、经度、高 程位置。而目前固体火箭制导中还未出现对箭体姿态调整使箭体某一轴线定向 进行设计的方法，也未出现相关理论研究工作。

因此，亟待一种使飞行器某一轴线指向地面固定位置时对飞行器的姿态角 进行控制的方法。

发明内容

本发明提出了一种飞行器姿态角控制方法、控制装置及存储介质，旨在解 决现有技术中还未出现对箭体姿态定向调整进行设计的方法的问题。

根据本申请实施例的第一个方面，提供了一种飞行器姿态角控制方法，包 括以下步骤：

根据目标点的地心系坐标以及飞行器的地心系坐标计算飞行器-目标矢量 的地心系投影；

根据飞行器-目标矢量的地心系投影得到飞行器-目标矢量的发射惯性系投 影；

根据飞行器-目标矢量的发射惯性系投影进行归一化得到飞行器姿态角指 令输入参数；

根据飞行器姿态角指令输入参数得到飞行器姿态角指令；

根据飞行器姿态角指令控制飞行器姿态角。

根据本申请实施例的第二个方面，提供了一种飞行器姿态角控制装置，具 体包括：

飞行器-目标矢量的地心系投影模块，用于根据目标点的地心系坐标以及 飞行器的地心系坐标计算飞行器-目标矢量的地心系投影；

飞行器-目标矢量的发射惯性系投影模块，用于根据所述飞行器-目标矢量 的地心系投影得到飞行器-目标矢量的发射惯性系投影；

飞行器姿态角指令输入参数模块，用于根据所述飞行器-目标矢量的发射 惯性系投影进行归一化得到飞行器姿态角指令输入参数；

飞行器姿态角指令模块，用于根据所述飞行器姿态角指令输入参数得到飞 行器姿态角指令；

控制模块，用于根据所述飞行器姿态角指令控制飞行器姿态角。

根据本申请实施例的第三个方面，提供了一种计算机可读存储介质，其上 存储有计算机程序；计算机程序被处理器执行以实现飞行器姿态角控制方法。

采用本申请实施例中的飞行器姿态角控制方法，通过根据目标点的地心系 坐标以及飞行器的地心系坐标计算飞行器-目标矢量的地心系投影；再根据飞 行器-目标矢量的地心系投影得到飞行器-目标矢量的发射惯性系投影；然后根 据飞行器-目标矢量的发射惯性系投影进行归一化得到飞行器姿态角指令输入 参数；最后根据飞行器姿态角指令输入参数得到飞行器姿态角指令控制飞行器 姿态角。实现使其飞行器X、Y及Z某一轴线或任意轴线指向地面固定位置时 进行飞行器姿态角度约束控制，解决了目前还未出现箭体姿态调整使箭体某一 轴线定向的问题。

附图说明