一种柔性拦截网空间姿态预测及计算方法与流程

本发明涉及柔性网动力学预测与发射控制，具体涉及一种柔性拦截网空间姿态预测及计算方法。

背景技术：

1、柔性拦截网是一类依靠牵引质量块带动柔性网线展开，并利用形成的网面包覆、约束运动目标的非刚性捕获装置。网体通常由大量节点和仅承受轴向拉力的绳索单元构成，具有收纳体积小、展开覆盖范围大及接触缓冲性较好的特点。柔性拦截网姿态在线预测及发射时序控制用于在网体发射、展开至接近目标期间，估计网体质心、网面朝向和有效张开面积，并为牵引质量块的触发时刻及初速度设置提供依据。

2、在目标快速接近捕获区域的任务中，从牵引质量块发射到网面形成可用捕获面积通常仅有较短时间，且目标跟踪、执行反馈与姿态计算具有各自的时间戳。网线在展开过程中并非始终受力，同一绳索会随张力扰动传播而经历松弛与绷紧，相邻区域的状态切换还存在明确的先后关系。因此，控制器不仅需要判断网体最终能否张开，还需要确定目标进入捕获包络时，网体是否已形成足够的有效面积并保持适当朝向。

3、现有在线计算通常采用固定步长推进，并仅在步末根据绳索长度更新受力状态。为满足实时控制要求，计算步长一般按照控制周期设置，难以覆盖绳索状态切换的微小时间尺度。当一个计算步内连续发生多个切换，或者绳索先绷紧后松弛时，步首和步末的长度状态可能相同，相关变化容易被遗漏；多个本应先后发生的切换也可能被集中至步末处理。由此得到的网面展开过程会表现为相邻区域近同时受力及局部张力突增，使有效张开面积达到要求的预测时刻偏离实际时刻。控制器若依据该结果调整发射，目标到达时可能出现网面尚未充分张开、网体尚未对准或者网面已经提前收拢的现象，目标容易从网边或未覆盖区域穿过。若为避免上述现象而在整个展开过程中统一采用微秒级小步长，又会显著增加数万节点及绳索单元的计算量，难以在毫秒级控制周期内持续输出姿态。因此，现有技术在高速展开捕获场景中主要存在网体有效展开时刻预测失真，导致发射时机与目标到达时机不匹配的问题。

技术实现思路

1、针对上述问题，本发明提出了一种柔性拦截网空间姿态预测及计算方法，包括：s101、读取节点状态、绳索拓扑和材料参数，按实测牵引速度及发射张角修正初始条件；固定仅传递轴向拉力的绳索单元的绷紧或松弛状态试算当前区间，获取两端事件指示量及变化率，所述事件指示量为轴向伸长量与自然长度之比；s102、利用所述事件指示量及变化率重建步内轨迹，按轨迹单调区间定位与当前受力状态相容的有效过零，并将切换时刻写入候选事件队列；s103、选取最早切换时刻，恢复区间起点并固定状态重新积分；校验过零后保持节点位置和速度连续并更新受力状态，基于更新状态重定位剩余事件直至名义步结束；s104、比较名义步机械能变化与外力做功以校验能量闭合，对不闭合子区间细分并重复事件处理，校验失败则不输出该步结果；s105、根据通过校验的节点状态合成网体姿态，将目标状态外推至姿态时刻，依据预测姿态满足捕获条件与目标进入捕获包络的时刻先后，调整未执行的发射时刻或牵引初速度。

2、相较于采用固定步长连续积分、忽略绳索绷紧与松弛切换细节的现有预测方式，本发明能够在柔性拦截网展开过程中识别并精确处理步内受力状态切换，减少事件漏检、误切换、时序颠倒及由此引起的姿态预测偏差；通过在事件边界恢复并重新积分、对后续事件进行动态重定位，使节点运动在切换前后保持连续并符合绳索仅承受拉力的物理规律；通过能量闭合校验和不合格结果阻断机制，避免数值误差累积形成表面合理但物理失真的姿态结果；进一步将可信的网体姿态与同一时刻的目标状态进行匹配，并据此调整尚未执行的发射时刻或牵引初速度，从而形成由动力学预测到发射控制的闭环，提高拦截网展开姿态与目标到达捕获区域的时间匹配程度，增强复杂环境下在线捕获控制的准确性、稳定性和安全性。

3、进一步地，初始化时依据所述事件指示量的正负设置绷紧态或松弛态；试算采用速度维尔莱积分，先以区间起点节点合力更新试算终点位置，再依据该位置和固定的受力状态重算节点合力，并以区间两端加速度更新试算终点速度；松弛单元张力保持为零，绷紧单元按照实际轴向伸长计算张力，连续环境载荷计入节点合力。

4、相较于对全部绳索单元统一施加弹性力或在积分过程中任意改变受力状态的现有方式，本发明能够避免松弛绳索产生不符合实际的压缩力，并在固定受力状态下协调更新节点位置、节点合力和节点速度，使试算结果更准确地反映柔性网的单边受力特性；同时将连续环境载荷纳入节点合力，有利于降低外部扰动被忽略所造成的轨迹偏差，兼顾在线计算效率与节点状态预测精度，为后续切换事件定位提供稳定、可信的区间端点数据。

5、进一步地，所述步内轨迹根据区间两端的事件指示量及其变化率采用三次厄米插值形式重建；以所述步内轨迹的有效驻点和区间端点划分单调区间，分别检查各单调区间的过零；轨迹在零线相切但未改变正负号时不认定为切换，并按照当前受力状态保留过零方向相容的首次切换。

6、相较于仅依据积分步两端事件指示量的正负变化判断状态切换的现有方式，本发明能够利用两端数值及变化率还原步内变化趋势，并在单调区间内检查过零，从而发现端点同号情况下仍可能存在的步内有效切换；通过排除仅与零线相切而未发生符号改变的情形，并仅保留与当前受力状态相容的首次过零，可减少虚假切换和重复切换，提高绳索绷紧、松弛事件识别的完整性及方向正确性。

7、进一步地，对存在过零的所述单调区间先采用带区间约束的牛顿迭代定位根，在迭代超出所述单调区间或导数过小时改用二分定位；利用数值确认带抑制零点附近的重复切换，仅在轨迹沿切换方向离开所述数值确认带后确认有效事件；定位未收敛时等分搜索过零区间，仍未满足时间精度要求时恢复区间起点并缩短区间。

8、进一步地，到达最早切换时刻后重新计算对应绳索单元的事件指示量，并在偏离零点时通过固定状态重复积分和二分定位修正切换时刻；较早事件更新后使其余候选事件失效；时差不超过定位误差的事件按时刻和单元编号排序，仅将同时满足零点位置及正确过零方向的事件在同一事件边界成组更新。

9、相较于按照初始候选列表依次处理事件而不再校验其有效性的现有方式，本发明能够在最早事件到达时重新确认其零点位置和过零方向，并在状态更新后使已失效的候选事件退出处理，避免旧候选事件破坏真实的动力学因果顺序；对于时间上近似同时发生的多个切换，本发明采用确定性排序和成组更新方式，可减少处理顺序不同导致的计算结果差异，更真实地反映多根绳索同步绷紧或松弛的工况，提高仿真结果的一致性和可重复性。

10、进一步地，每次事件更新后重新计算节点内力并试算剩余区间；当事件边界数量超过预设上限或无时间推进的重复检查产生矛盾切换时，恢复区间起点并缩短区间；达到预设最小区间长度或最大连续回退次数仍未完成计算时，将所述名义步标记为无效并停止输出其结果。

11、相较于在密集事件或矛盾切换出现时持续迭代并输出异常结果的现有方式，本发明能够在每次状态更新后基于新的节点内力重新计算剩余区间，并利用区间回退和缩短机制化解事件风暴、无时间推进及相互矛盾的切换；在达到计算能力边界后将名义步明确标记为无效并停止输出，可防止未完成或不稳定的节点状态继续传播至姿态预测和控制环节，提高在线计算的故障可控性与输出可靠性。

12、进一步地，所述机械能变化包括全部节点的总动能变化以及处于绷紧且正伸长状态的绳索单元的弹性能变化；所述外力做功根据各子区间的外力及节点位移确定；当机械能变化与外力做功的差额不满足以起点机械能和外力做功绝对值中的较大者为参考的允许条件时，定位能量不闭合最明显的子区间并细分后重新执行试算、轨迹重建、事件定位和分段推进。

13、进一步地，当模型包含阻尼时，从能量变化中扣除阻尼耗散能；当计算范围扩展至目标接触后，计入接触力做功或接触冲量引起的能量变化；每次细分后重新计算整个名义步的能量变化，达到预设细分轮次仍未闭合时，恢复至上一有效名义步的终点状态，并禁止未闭合状态参与姿态更新和发射控制。

14、进一步地，按节点质量计算网体三维质心，以节点相对质心的位置构造惯性张量并进行对称特征分解以获得主轴方向；依据上一时刻主轴保持方向连续，在两个惯性特征值之差小于预设阈值时结合上一时刻主轴与边界节点平均延伸方向确定网面内方向；由网面法向投影获得有效张开面积，网面折叠时对网格投影多边形的重叠区域仅计一次并扣除孔洞区域。

15、进一步地，将带时间戳的目标位置和速度外推至姿态帧时刻，以最低有效张开面积、允许网面法向偏差和允许质心偏差确定首次满足捕获条件的时间区间；根据所述时刻先后提前或延后触发，或提高或降低牵引初速度；对独立触发的牵引质量块仅调整尚未发射者；在目标数据无效、姿态未更新、执行反馈饱和或能量校验失败时保持最近一次有效参数，并在数据恢复后重新进行发射时序对齐。

16、本发明的技术效果为：本发明的核心创新在于构建面向柔性拦截网单边受力特性的事件驱动预测与发射闭环控制机制，以绳索轴向伸长状态为事件依据，精确定位并按时序处理绷紧、松弛切换，通过状态恢复、分段重积分及能量闭合校验保证节点运动结果的物理可信度；在此基础上稳定提取网体质心、主轴和真实有效张开面积，将其与时间同步后的目标状态进行捕获窗口匹配，并动态调整未执行的发射时刻或牵引速度，从而降低传统连续积分中的漏事件、能量漂移和姿态误判，提高在线预测可靠性及拦截控制精度。