实现概率速度运动模型时μ分母为0的处理方案咨询

针对《概率机器人》第97页的概率版VMM实现，当μ的计算出现分母为0的情况，本质是机器人处于近似纯直线运动状态（旋转角度变化量Δθ≈0），直接设为0会破坏后续概率计算的合理性，以下是两种可行的处理方式：

• 分支切换（最严谨）：
  不要硬算μ，而是直接切换到直线运动的逻辑。判断Δθ的绝对值是否小于一个极小的浮点阈值（比如1e-6，避免浮点精度误差导致的误判），如果满足，直接用直线运动的位姿更新公式：

  delta_theta = theta_prime - theta;
  eps = 1e-6;
  if abs(delta_theta) < eps
      x_new = x + v * delta_t * cos(theta);
      y_new = y + v * delta_t * sin(theta);
      theta_new = theta;
      % 后续概率计算也对应直线运动的噪声模型
  else
      mu = (v * delta_t) / delta_theta;
      % 常规旋转运动的概率计算逻辑
  end
  

  这种方式完全贴合物理意义，避免了分母为0的问题，也不会引入不合理的数值。

• 设置大的有限值（退而求其次）：
  如果不想单独做分支判断，可以将μ设为一个远大于机器人最大运动尺度的有限值（比如机器人最大移动距离的100倍，假设机器人作业范围是10m，就设μ=1000m）。这个取值模拟了“曲率无穷大”的直线运动特性，同时不会导致数值溢出或后续概率计算异常。

注意：绝对不要直接设μ=0，这会导致后续高斯分布的参数计算出现NaN或完全不符合物理规律的概率值，严重影响运动模型的准确性。

内容的提问来源于stack exchange，提问作者Samuele Bani