ROS 2 Gazebo中阿克曼转向车Follow-the-Gap算法优化问询

一、转向目标点优化（解决过度转向） #

• 放弃最大间隙中点，改用间隙内最远点+偏向道路外侧的偏移修正：最远点能引导车辆往最开阔区域行驶，偏移修正可避免贴向障碍物导致的猛打方向。比如间隙在左侧时，将最远点稍微右移0.05-0.15弧度；间隙在右侧时，稍微左移相同幅度，偏移量可根据车宽微调。
• 过滤过小间隙：设置最小间隙长度阈值（比如0.6m，略大于车宽），直接忽略小于该阈值的间隙，避免车辆试图挤入窄缝引发过度转向。

二、转向控制平滑（消除行驶振荡） #

• 加入低通滤波：对目标转向角进行平滑处理，示例逻辑：

  alpha = 0.3  # 平滑系数，0.2-0.4之间调整，越小越平滑
  current_steer = alpha * target_steer + (1 - alpha) * current_steer
  

• 限制最大转向角：F1TENTH车辆物理最大转向角约为30度（≈0.52弧度），强制将输出转向角限制在±0.52弧度内，避免超出机械极限导致失控。
• 设置转向死区：当目标转向角与当前转向角的差值小于0.01弧度（约0.57度）时，不更新转向指令，避免频繁微调引发振荡。

三、自适应速度控制（解决大转向时车速过快） #

• 转向角联动减速：采用非线性映射函数，将转向角与车速绑定，示例逻辑：

  import math
  max_speed = 2.0  # 直线最大行驶速度（m/s）
  min_speed = 0.5  # 最大转向时的最低安全速度
  max_steer = math.radians(30)
  steer_angle_abs = abs(current_steer)
  # 转向角越大，速度下降幅度越大
  speed = max_speed * (1 - (steer_angle_abs / max_steer) ** 2)
  

• 前方障碍物紧急减速：提取激光扫描中车头正前方±10度范围内的最小距离，当距离小于1.5m时，按比例降低车速：

  front_min_dist = min(scan_ranges[len(scan_ranges)//2 - 10 : len(scan_ranges)//2 + 10])
  if front_min_dist < 1.5:
      speed = max(0.2, speed * (front_min_dist / 1.5))
  

四、关键参数调优细节 #

• 激光平滑窗口：设置为5-10个激光点，过大导致决策延迟，过小无法有效过滤噪声。
• 安全气泡半径：设为车宽的1.2-1.5倍（比如车宽0.3m，半径0.4m），既保证不刮蹭，又不会过度缩小可行驶区域。
• 间隙查找范围：限制激光扫描的有效角度为±90度（车头左右各90度），忽略后方数据，减少无效计算。

内容的提问来源于stack exchange，提问作者ahmad yar