如何求解平面投影螺旋运动的中位轨迹并估算螺旋振幅？

问题背景 #

若干物体做复杂3D螺旋运动，已获取其平面投影轨迹（轨迹呈现多条交织的螺旋曲线，围绕中心区域波动），需求解中位轨迹（即位于所有轨迹波峰与波谷之间的基准线条，示例为一条贯穿螺旋中心、处于各轨迹中间位置的顺滑曲线），并估算螺旋振幅。

一、中位轨迹求解算法 #

1. 轨迹参数化与对齐 #

先对所有离散轨迹做参数化处理：

• 将每条轨迹按弧长重采样，统一生成N个等弧长分布的点，确保不同轨迹的点能按运动进度一一对应；
• 若轨迹点序列存在缺失，可使用scipy.interpolate.splprep进行B样条插值，补全连续轨迹曲线。

2. 逐点计算中位值 #

对参数化后同一位置的所有轨迹点，计算其x、y坐标的中位数（相比均值，中位数对轨迹中的异常点抗干扰能力更强），将这些中位值点依次连接，得到初始中位轨迹。

3. 平滑优化 #

离散计算得到的初始中位轨迹可能存在毛刺，可采用以下方式优化：

• 滑动窗口平滑：取5-10个点的窗口，对窗口内的坐标做均值或中位数滤波；
• B样条拟合：用scipy.interpolate.splrep拟合初始中位轨迹点，生成顺滑的连续曲线。

二、螺旋振幅估算算法 #

1. 计算轨迹点到中位轨迹的距离 #

对每条原始轨迹上的所有点，计算其到中位轨迹的垂直距离：

• 先找到该点在中位轨迹上的垂足（通过投影到轨迹切线方向求解）；
• 计算该点与垂足之间的欧氏距离，即为该点相对于中位轨迹的偏移量。

2. 统计振幅值 #

• 按参数位置分组，对每组内的偏移量取绝对值，计算最大值（波峰偏移）与最小值（波谷偏移）的平均值，得到该位置的局部振幅；
• 对所有局部振幅取均值，即为整体螺旋振幅的估算值；
• 若需避免极端值干扰，可统计所有偏移量的95%分位数作为振幅参考。

进阶优化方法 #

• 动态时间规整（DTW）：若各轨迹的运动进度不同步，可使用DTW算法实现轨迹间的最优对齐，再执行中位值计算；
• 主成分分析（PCA）：对所有轨迹点的集合做PCA，第一主成分的方向即为中位轨迹的大致走向，垂直主成分方向的标准差可作为初始振幅参考。

内容的提问来源于stack exchange，提问作者Ivan Z