一种多核异构处理器的动力学硬件加速方法及加速器

摘要: 本发明涉及卫星控制仿真与嵌入式计算,具体涉及一种多核异构处理器的动力学硬件加速方法及加速器。背景技术:1、为抑制飞轮振动、挠性附件抖动等平台微振动对精密载荷的干...
一种多核异构处理器的动力学硬件加速方法及加速器

本发明涉及卫星控制仿真与嵌入式计算,具体涉及一种多核异构处理器的动力学硬件加速方法及加速器。

背景技术:

1、为抑制飞轮振动、挠性附件抖动等平台微振动对精密载荷的干扰,越来越多的卫星控制分系统采用多级复合控制架构,在传统卫星平台姿态控制的基础上增加主动指向超静平台作为载荷端的二级控制,通过主动隔振和指向微调进一步隔离残余扰动。然而,主动指向超静平台需要与卫星平台控制系统协同进行复合控制,二者在动力学上相互耦合,且控制周期差异显著——主动指向超静平台的控制周期通常为亚毫秒至毫秒级,整星姿态控制周期通常为百毫秒级。因此,需要建立能够在同一仿真环境中同时运行不同周期的动力学模型、并支持星体姿态控制回路与载荷指向及隔振控制回路之间实时信息交互的多级复合控制仿真验证环境。

2、在《航天器工程》2023年第32卷第3期第101-107页发表的《北京三号a/b卫星控制分系统设计与仿真验证》中公开了一种已成功应用于在轨卫星的多级复合控制仿真验证平台。该平台根据动力学耦合及协同设计方法搭建,设置了三种工作模式:下平台独立测试模式、上平台软件测试模式和上下平台复合控制测试模式,可支持不同研制阶段的仿真验证需求。在工程实现方式上,该平台将下平台地面动力学部署在地面测试设备的嵌入式操作系统中,将上平台地面动力学部署在独立的数字信号处理器与现场可编程门阵列智能板卡中;下平台动力学按5毫秒周期将姿态数据写入智能板卡的指定缓存,上平台动力学按0.5毫秒仿真周期运行,并将上平台姿态数据和作动器作用力数据存储至指定地址缓存供下平台动力学读取;地面测试设备与智能板卡之间通过缓存管理、同步信号、周期匹配和校时逻辑保证数据一致性与时序匹配。

3、上述现有技术存在以下不足。第一,该方案需要地面测试设备和数字信号处理器与现场可编程门阵列智能板卡两套独立硬件,系统硬件复杂度高,并且需要专用的板间缓存交互链路和外部同步机制,板间数据搬移延迟大。第二,上下平台之间的同步一致性依赖于外部同步信号的精度和校时准确性,同步相位偏差难以进一步压缩。第三,上下平台的动力学计算均由处理核心串行执行,而多体耦合动力学求解中包括惯性矩阵求逆、地球非球形引力摄动计算、并联系机构力学传递计算和数值积分等密集计算,占用大量处理核心算力,导致单步计算耗时长,难以在更小的仿真步长下保证实时性。第四,动力学计算的中间状态需要在地面测试设备与智能板卡之间往返传递,进一步增加了数据交互开销并引入时序不确定性。

4、公开号为cn119292104b的中国发明专利公开了一种复杂连接卫星多级控制的数字物理平行仿真验证方法,其建立载荷平台数字仿真模型和整星平台数字仿真模型,根据卫星平台与载荷平台的连接机构建立关节连接模块数字仿真模型和关节连接模块物理模型,根据预设相对位置姿态运动序列对二者进行一致性评估,并在评估结果为一致时分别对载荷平台数字仿真模型和整星平台数字仿真模型进行仿真验证。该方案属于模型构建与一致性验证层面,未涉及仿真验证平台的硬件实现方式,也未涉及动力学计算的硬件加速手段。

5、因此,如何在降低硬件复杂度与数据交互开销的同时提高多体耦合动力学计算的实时性与步内时序一致性,是本领域亟待解决的技术问题。

技术实现思路

1、本发明的目的在于针对现有多级复合控制仿真验证平台采用分板卡方案时硬件复杂度高、板间数据搬移延迟大、同步一致性依赖外部同步信号、动力学密集计算占用处理核心算力导致实时性受限等问题,提供一种多核异构处理器动力学硬件加速方法及加速器,将多体耦合动力学的数值计算集中于单一多核异构处理器的可编程逻辑侧完成,并在可编程逻辑侧对积分阶段进行顺序复用、对引力摄动进行在线解析计算与离线建表的分解,以降低硬件复杂度与数据交互开销,并提高单步计算速度和步内时序一致性。

2、为了实现上述目的,本发明采用以下技术方案:

3、第一方面,本发明提供一种多核异构处理器的动力学硬件加速方法,多核异构处理器包含处理系统侧和可编程逻辑侧,包括以下步骤:

4、步骤1、处理系统侧的动力学处理单元接收平台通信模块传递的gnc数据,读取预先生成的二维引力残差表,将参数和表数据送入输入参数缓存与片上表存储,并传入本步状态与控制指令,输入参数缓存锁存控制量,执行机构计算模块更新框架角并计算角动量与力矩;

5、步骤2、按gill型四阶龙格库塔积分关系构造当前阶段动力学状态,并将相同阶段的数据送入各计算通路,所述计算通路包括几何与杆力通路、引力通路及状态微分通路,通过几何与杆力通路计算六杆雅可比与轴向力并映射为两体合力及力矩,引力通路与该几何与杆力通路并行执行,在线计算中心引力与二阶带谐项,并依据二维引力残差表取四邻点作双线性插值及径向补偿,通过状态微分通路组装当前阶段斜率;

6、步骤3、保存当前阶段斜率,按阶段间依赖顺序重复步骤2直至四个积分阶段完成,中间状态与阶段斜率保存于片上存储;

7、步骤4、按gill积分关系合并四组阶段斜率得到下一时刻的动力学状态,归一化两体的动力学状态中的姿态四元数,并根据合并后动力学状态计算相对运动反馈量;

8、步骤5、将当下时刻完整动力学状态、更新后的控制力矩陀螺(cmg)框架角、相对运动反馈量及相应的步号与时刻构成的完整结果写回存储器,待写响应全部返回后提交完成标志并通知动力学处理单元,由动力学处理单元将相对运动反馈量经平台通信模块发送至gnc软件或载荷控制器,并将当下时刻完整动力学状态及更新后的控制力矩陀螺(cmg)框架角作为下一动力学步的起始状态,自步骤1起重复执行,其中二维引力残差表仅在仿真启动阶段装载一次。

9、进一步地,所述二维引力残差表按以下方式生成:以jgm3球谐模型在参考地心距处、按地心纬度与地心经度划分的网格节点上,逐节点计算扣除中心引力与二阶带谐项后的残差加速度向量,以及该残差加速度向量对地心距的偏导数与径向归一化长度相乘所得的缩放径向导数向量,并将上述两个向量按固定小数点位置量化为定点数后存为只读表。

10、进一步地,所述网格在纬度方向取257个节点、在经度方向取512个节点,每个节点存储残差加速度向量的三个分量和缩放径向导数向量的三个分量,各分量均为24位定点数;所述只读表在仿真启动阶段一次装载至可编程逻辑侧的片上存储,后续仿真周期中不再访问外部存储器。

11、进一步地,所述双线性插值及径向补偿包括:对残差加速度向量和所述缩放径向导数向量的任一分量,取当前点所在网格单元的四个邻点值,以当前点在纬度方向与经度方向的单元内比例为权重,沿两个方向分别线性加权并求和;将当前地心距与参考地心距之差除以所述径向归一化长度,与插值得到的缩放径向导数向量相乘后,再与插值得到的残差加速度向量相加,得到补偿后的地固系残差加速度。

12、进一步地,所述中心引力与二阶带谐项由引力通路按当前阶段的地固系位置在线解析计算,所述状态微分通路将在线计算的中心引力与二阶带谐项与所述补偿后的地固系残差加速度在同一坐标系中相加后参与状态求导。

13、进一步地,所述几何与杆力通路按以下方式计算:由两体的动力学状态中的姿态四元数生成方向余弦矩阵,将卫星与载荷各自体轴系中的铰点坐标变换至惯性系,按杆并行计算各杆的方向矢量、长度、伸缩速度以及卫星端雅可比矩阵与载荷端雅可比矩阵,再按主动控制力指令、弹簧刚度与阻尼系数计算各杆轴向力,并通过两个雅可比矩阵的转置将各杆轴向力映射为作用于卫星与载荷的合力及力矩;所述几何与杆力通路与所述引力通路的输入相互独立,二者以并行硬件通路同时执行。

14、进一步地,所述步骤2中,在启动当前阶段前构造该阶段的输入状态,并在当前阶段的斜率完整保存后启动下一阶段;每次积分开始时仅更新一次框架角、角动量与力矩,四个积分阶段共用更新后的结果。

15、进一步地,所述按gill积分关系合并四组阶段斜率包括:以1、2与根号2之差、2与根号2之和、1为权重分别对第一至第四阶段斜率加权求和,再乘以积分步长的六分之一并与起始状态相加。

16、进一步地,所述动力学处理单元与所述可编程逻辑侧之间通过控制接口与数据接口交互,所述控制接口用于传递配置数据、控制指令、仿真时间与步长以及启动和完成状态,所述数据接口用于批量搬运状态向量、系统结构参数与输出结果。

17、进一步地,所述处理系统侧包含第一处理核心、第二处理核心、第三处理核心和第四处理核心,所述第一处理核心部署系统服务与统一消息内核,所述第二处理核心部署ethercat主站周期通信,所述第三处理核心部署网络通信,所述第四处理核心部署动力学仿真与调度;四个处理核心之间通过片上共享存储与软件中断交换数据。

18、进一步地,所述多核异构处理器中的各物理量按其数值范围采用差异化定点数位宽,二维引力残差表中的各分量采用24位有符号定点数存储;双线性插值权重采用1位整数位和24位小数位的无符号定点格式,插值乘加采用不少于56位的中间计算位宽,插值结果按对应缩放因子对齐至后续运算所需的定点格式,径向补偿、引力加速度合成及状态积分均采用定点运算。

19、第二方面,本发明提供一种多核异构处理器的动力学硬件加速器,包括处理系统侧的动力学处理单元、存储单元和可编程逻辑侧的pl计算单元;动力学处理单元包含配置管理模块、输入组织与调度模块和结果处理模块;存储单元包含双倍数据速率存储器和可编程逻辑侧片上存储;pl计算单元包含数据输入模块、输入参数缓存、执行机构计算模块、片上表存储模块、阶段调度与存储模块、耦合求导模块、状态合并与反馈计算模块、输出缓存和数据输出模块。

20、进一步地,所述数据输入模块通过axi4主接口读取ddr中的数据,将状态送入起始状态存储,将控制量和参数送入输入参数缓存;在仿真准备时,将二维引力残差表写入片上表存储模块;所述输入参数缓存暂存本步控制量、环境扰动、固定结构参数及阶段坐标变换矩阵,向执行机构计算模块和耦合求导模块提供数据,本步计算期间保持所锁存输入不变;所述执行机构计算模块读取当前cmg框架角、速率指令及扰动,在线更新框架角,计算cmg角动量和力矩,将结果保存在本地缓存中,供本步四个积分阶段使用。

21、进一步地,所述片上表存储模块采用pl片上存储资源保存启动阶段装入的二维引力残差表,并按引力通路给出的地址输出同一网格单元四个邻点的残差加速度分量与缩放径向导数分量;所述输出缓存暂存最终本步完整动力学状态、更新后的cmg框架角、相对运动反馈量及相应的步号与时刻,供数据输出模块读取;所述数据输出模块将完整结果写回存储器,待写响应全部返回后提交完成标志并通知动力学处理单元。所述阶段调度与存储模块分别保存起始状态、临时状态和四组阶段斜率,按gill型四阶龙格库塔积分关系构造当前阶段的输入状态,并在当前阶段结果有效后启动下一阶段;所述耦合求导模块包含几何与杆力通路、引力通路和状态微分通路,几何与杆力通路设置为计算六杆几何量、雅可比与轴向力并映射为两体合力及力矩,引力通路设置为在线解析计算中心引力与二阶带谐项并依据二维引力残差表作四个邻点双线性插值及径向补偿,状态微分通路设置为组装当前阶段斜率;所述状态合并与反馈计算模块设置为按gill积分关系合并四组阶段斜率得到下一时刻状态、归一化两体的动力学状态中的姿态四元数,并根据合并后的状态计算相对运动反馈量。

22、第三方面,本发明提供一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被多核异构处理器执行时实现上述的动力学硬件加速方法。

23、本发明与现有技术相比具有以下优点:

24、其一,降低硬件复杂度并缩短数据交互路径。本发明将多级复合控制仿真所需的动力学求解、实时总线通信与网络通信统一部署于单一多核异构处理器内,由可编程逻辑侧承担全部耦合动力学数值计算,处理系统侧仅负责预计算、任务调度、参数配置与结果分发。相较于将上下平台动力学分别部署于地面测试设备与智能板卡的分板卡方案,本发明取消了专用的板间缓存交互链路和外部同步机制,减少了跨硬件的数据搬移,使系统同步关系由外部同步转为片内统一时钟下的时序关系。

25、其二,减少在线计算量与外部访存等待。本发明将引力摄动计算分解为在线解析与离线建表两部分:中心引力与二阶带谐项随位置变化剧烈且量级最大,保留在线解析计算以保证精度;其余球谐项变化平缓、可由地心纬度与地心经度二维参数化,故在参考地心距处离线预计算为二维引力残差表并连同径向导数一同存于可编程逻辑侧片上存储,在线仅需取四邻点作双线性插值并按实际地心距作一阶径向补偿。该分解消除了在线球谐递推与高阶三角函数的重复计算,且二维引力残差表在启动阶段一次装入片上存储,运行期间无需访问外部存储器。

26、其三,兼顾计算并行性与硬件资源利用率。本发明在耦合求导模块内部使几何与杆力通路和引力通路并行执行、六杆几何计算按杆并行展开;同时按照积分阶段之间的数据依赖关系,使四个积分阶段顺序复用同一套耦合求导硬件,并将中间状态与阶段斜率保存于片上存储。相较于为四个积分阶段分别配置完整求导硬件的方式,本发明在保持阶段依赖关系的前提下减少了重复的算子配置与硬件资源占用。

27、其四,保持控制输入、动力学状态与反馈数据之间的对应关系。本发明在动力学步边界锁存控制输入,四个积分阶段共用同一步的有效输入与执行机构计算结果;状态合并完成后根据步末状态计算反馈量,并仅在完整结果全部写回后提交完成标志并通知处理系统侧读取。由此避免阶段的中间结果或未完整写回的数据进入控制回路,并支持动力学硬件加速器与不同控制周期的控制分系统对接。