1.介绍

1.1. 换道的功能

简单地说, 换道的作用就是从待选地参考线中选择其中一个参考线, 供 planning 后续模块进行使用.

☞☞☞AI 智能聊天, 问答助手, AI 智能搜索, 免费无限量使用 DeepSeek R1 模型☜☜☜

需要说明的是，Apollo所开源的换道代码已经经过了大量的删减，仅保留了一个简单的框架。许多功能，如主动换道、被动换道（由于障碍物产生）、较为完整的状态机、换道窗口和Gap的选择等等都缺失了。本技术文章只展示现有框架上的内容。关于其他换道功能的内容，请期待后续的文章

1.2. 换道状态机

Apollo 当前的换道状态机如下:

对状态机有一下几点值得注意:

• 这里的IN_CHANGE_LANE同时包含了换道执行和换道准备两个阶段. 正常情况下应该加以区分. Apollo 采取的是先切换参考线后执行换道动作的方法, 也有友商会采用先执行换道动作在切换参考线的方法(好处是切换参考线的那一帧, 自车的横向距离接近于 0).
• 当前代码中并没有体现出什么时候会换道失败. 同样有理由相信是由于删除相关代码导致的.
• 完整的换道状态应该至少包含: 换道准备, 换道执行, 换道保持, 换道取消, 换道完成等状态.

2. 代码解析

2.1. 整体流程

相关代码所在路径: modules/planning/tasks/deciders/lane_change_decider/http://lane_change_decider.cc

1. 处理reference_line_info为空的异常情况.
2. 如果配置了强制换道reckless_change_lane为true, 则直接更新 Reference Line.
3. 获取上一帧的换道状态prev_status, 刚进入程序时, 可能prev_status没有状态信息(!prev_status->has_status()), 此时直接认为处于换道完成状态.
4. 如果reference_line_info的数量为 1(即has_change_lane为false), 说明自车处在巡迹状态, 自车当前所在的车道拥有唯一的车道线, 周围没有可变车道, 所以直接更新换道状态即可.
5. 切换换道的状态机

• 上一帧处在换道状态ChangeLaneStatus::IN_CHANGE_LANE: 如果上一帧自车所在的 Lane 和这一帧所在的 Lane 相同, 说明自车还在往目标车道上走. 反之如果上一帧自车所在的 Lane 和这一帧所在的 Lane 不同, 说明自车已经在目标车道上了, 切换已经完成.
• 上一帧处在换道失败状态ChangeLaneStatus::CHANGE_LANE_FAILED: 如果换道失败, 则冻结状态一段时间, 然后切换到正在换道状态, 为下一次换道做准备.
• 上一帧处在换道完成状态ChangeLaneStatus::CHANGE_LANE_FINISHED: 换道成功后同样冻结一段时间, 然后切换到正在换道状态, 为下一次换道做准备. 这里冻结时间是为了避免频繁换道.

2.2. 安全检查

IsClearToChangeLane判断换道是否安全.

1. 本安全判断方法不考虑虚拟障碍物(Virtual Obstacles)和静态障碍物(Static Obstacles).
2. 计算动态障碍物在 Reference Line 上面的投影. 投影的几何意义如下图所示:

1. 如果自车正在换道IsChangeLanePath, 利用上面计算的投影关系来忽略目标参考线的车道之外的障碍物.
2. 判断障碍物的行驶方向是否和自车相同same_direction. 根据障碍物与自车的行驶方向的关系和速度关系分别计算前向安全距离和后向安全距离.
3. 如果自车和障碍物之间的距离大于上面计算的安全距离, 则认为可以安全换道的. HysteresisFilter是一种 Open Close 逻辑, 目的是增加安全判断结果的稳定性(上一帧判断结果认为是安全的, 那么这一帧就更倾向于给出是安全的判断, 反之亦然).

2.3. 更新 Reference Line

需要重写的内容是：LaneChangeDecider::PrioritizeChangeLane

1. 输入: is_prioritize_change_lane. 如果is_prioritize_change_lane为true, 则找自车要切换的目标参考线. 反之如果is_prioritize_change_lane为false, 则找自车当前位置所在的 Lane 所在的参考线.
2. reference_line_info->splice(reference_line_info->begin(),*reference_line_info, iter);将步骤 1 找到的iter所指向的参考线放在链表的最前面. 由于 Planning 后续模块使用的都是reference_line_info().front(), 所以链表的最前面就表示当帧就是使用的参考线. splice的使用详细说明见C++ 基础.
3. 输出: ReferenceLineInfo链表.

原文链接：https://mp.weixin.qq.com/s/IQkBV8iadaU4Qy70F3Xs3Q

相关文章： 文心一言版插件攻略，轻松拓展功能，打造个性化体验,ai如何平滑  AI漫画解说模型，揭秘创作奥秘与展望无限应用前景,ai pcai  AI模型碎片获取揭秘，智能时代新武器大揭秘,ai99624  AI对不起，这个Adobe应用程序不是可用  智能语音新篇章，语音训练AI模型入门指南,小米的ai视频播放器  AI赋能敦煌，揭秘飞天模型制作的艺术与技术之旅,制作简历ai  AI巅峰对决，揭秘引领模型创新潮的企业争霸战,ai远点特效  好用的AI智能工具，让生活与工作更高效！  AI写作小助手：释放创意的力量，提升写作效率  文心一言证书申请攻略，流程解析及时间,ai芯片 民用  AI模型部署与实战，理论与实践深度剖析,ai优点分析  AI提炼文章重点：让你的内容精准、清晰、高效  轻松卸载小爱AI大模型，一键操作指南,成都牵手ai  AI赋能艺术，开启未来影像新,ai机器聊天  文章写作AI：让创作更高效、精准的智能助手  AI声音模型文件轻松解压攻略，实用技巧大揭秘,ai韵尾 成语  AI大模型前沿揭秘，李开复谈突破与未来应用展望,数学论文ai写作怎么写  揭秘文档问答AI模型，技术内核与应用全景,ai开汉堡  网站测试的重要性：确保用户体验与业务成功的关键步骤  文心一言小程序全新发布，开启便捷生活新篇章,ai写作头条有收益吗知乎  文心一言跨同步，电脑无缝数据共享体验,用ai写作文软件哪个好  AI赋能自然，探索逼真风景模型的智能构建奥秘,ai花朵字体设计  好用的人工智能AI软件推荐，让你的生活更智能！  360优化关键词-提升网站流量与排名的秘密武器,美拍ai  2025年度国内AI模型优选品牌榜，技术实力与市场口碑双优指南,ai智能机器写作  AI赋能写作新，AI训练文字模型软件革新助手亮相,AI封面简笔画  AI绘画中的脸谱，技术与文化的交汇桥梁,何洁 ai  AI绘画，探索模型应用、法律边界与安全防护,ai怎样制作沙雕动画  豆包AI写作助手，智能助力还是未来替代？,ai泰坦音响  智能AI写作生成：如何借助人工智能提升创作效率与质量  AI赋能金融，揭秘智能量化策略模型引领市场新,ai写作鱼是骗局吗  好用的AI写作软件免费推荐：创作新境界！  AI牙齿模型素材制作与应用全攻略教程,ios口语ai  AI绘画膨胀模型入门指南，解锁艺术与科技新境界,ai相机道具  华为AI模型导入攻略，解锁智能升级新路径,ai多美丽是什么歌  让“润色”更智能，人工智能助力内容创作新革命  文心一言，打造个性化写作风格的秘密武器,ai绘画萝莉写实  揭秘OpenAI模型参数，人工智能核心要素深度解析,ai调画质  文心一言领航AI浪潮，揭秘人工智能概念股投资新趋势,腾讯手机ai  摘要AI生成：高效工作的新时代利器  AI量化交易模型软件精选指南，助投资者金融市场扬帆远航,王者ai挑战20关  豆包智能AI多维度收费解析，满足个性化用户需求,ai20191122  文心一言资格获取全攻略，时长与流程深度解析,ai怎样进行切割  字节跳动AI豆包，开启全新智能生验之旅,猫上学ai  未来声音，最强AI变声模型下载全攻略,康熙AI  AI赋能，明星AI训练模型揭秘与未来趋势洞察,高达ai绘图  AI大模型投资新风口，揭秘股票机会与风险,ai裁剪涂层  PS镜头模糊问题深度解析，深度估计模型加载失败原因及对策,ai海洋男装  内容创作新时代：自动生成文章的AI如何改变写作生态  文心一言网页版全新上线，指尖畅享便捷创作体验,大神AI修复张柏芝