上海网站建设网页制作你却,做网站公司那家好,网站背景如何做,导购类网站怎么做1. abstract
本文主要讲解routing和planning模块中的reference line#xff0c;我之前一直搞不明白这个reference line是如何生成的#xff0c;有什么作用#xff0c;和routing以及planning的关系。现在有了一些心得打算梳理一下#xff1a; 决策规划模块负责生成车辆的行…1. abstract
本文主要讲解routing和planning模块中的reference line我之前一直搞不明白这个reference line是如何生成的有什么作用和routing以及planning的关系。现在有了一些心得打算梳理一下 决策规划模块负责生成车辆的行驶轨迹。要做到这一点决策规划模块需要从宏观到局部经过三个层次来进行决策。
第一个层次是Routing的搜索结果。Routing模块的输入是若干个按顺序需要达到的途径点也可能只有一个起点和终点。Routing模块根据地图的拓扑结构搜索出可达的完整路线来这个路线的长度可能是几公里甚至几百公里。因此这个是最为宏观的数据。另外Routing的搜索结果是相对固定的。在没有障碍物的情况下车辆会一直沿着原先获取到的Routing路线行驶。只有当车辆驶出了原先规划的路线之外例如为了避障才会重新发送请求给Routing模块以重新计算路线。第二个层次就是reference line。决策规划模块会实时的根据车辆的具体位置来计算reference line。reference line的计算会以Routing的路线为基础。但同时reference line会考虑车辆周边的动态信息例如障碍物交通规则等。reference line是包含车辆所在位置周边一定的范围通常是几百米的长度。相较于Routing结果它是较为局部的数据。第三个层次是Trajectory。Trajectory是决策规划模块的最终输出结果。它的依据是reference line。在同一时刻reference line可能会有多条例如在变道的时候自车所在车道和目标车道都会有一条reference line。而Trajectory是在所有可能的结果中综合决策和优化的结果最终的唯一结果。因此它是更为具体和局部的数据。轨迹不仅仅包含了车辆的路线还包含了车辆行驶这条路线时的详细状态例如车辆的方向速度加速度等等。
参考线是整个决策规划算法的基础。在Planning模块的每个计算循环中都会先生成参考线然后在这个基础上进行后面的处理例如交通规则逻辑障碍物投影路径优化速度决策等等。可以说参考线贯穿了整个Planning模块的实现。下面就看下reference line如何在routing和plannin中承前启后的 从这幅图中可以看出这里涉及到三个模块下面会挨个梳理
routing模块这部分内容追在Routing模块一文中讲解本文不再赘述。**pnc_map模块负责读取和处理Routing搜索结果。**是planning的子模块因为重要就把他单独拎出来了。planning模块根据Routing结果和车辆的实时状态包括周边环境生成reference line和trajectory。 2. routing
Routing模块正如其名称所示其主要作用就是根据请求生成路由信息。
模块输入
地图数据请求包括开始和结束位置
模块输出
路由导航信息
2.1 Topo地图 为了计算路由路径在Routing模块中包含一系列的类用来描述Topo地图的详细结构。这些类的定义位于modules/routing/graph/目录下。它们的说明如下 简单来说Topo地图中最重要的就是节点和边本质上是一系列的Topo节点以及它们的连接关系节点对应了道路边对应了道路的连接关系这个在Apollo开发者社区的技术文章中着重讲过。如下图所示 Routing模块需要的地图结构通过TopoGraph来描述而TopoGraph的初始化需要一个地图文件。但该地图文件与其他模块需要的地图文件并不一样这里的地图文件是Proto结构导出的数据。之所以这样做是因为Routing模块不仅需要地图的Topo结构还需要知道每条路线的行驶代价。在Proto结构中包含了这些信息。在下面的内容中我们将看到这个行驶代价是从哪里来的。
很显然两个地点的导航路径结果通常会有多个。而计算导航路径的时候需要有一定的倾向这个倾向就是行驶的代价越小越好。我们很自然的想到影响行驶代价最大的因素就是行驶的距离。
但实际上影响行驶代价的因素远不止距离这一个因素。距离只是宏观上的考虑而从微观的角度来看行驶过程中需要进行多少次转弯多少次掉头多少变道这些都是影响行驶代价的因素。所以在计算行驶代价的时候需要综合考虑这些因素。
再从另外一个角度来看在路线已经确定的情况下行驶的距离是一个物理世界客观存在的结果这是我们无法改变的。不过对于行驶过程中有多在意转弯掉头和变道每个人或者每个场景下的偏好就不一样了。而这就是配置文件“/apollo/modules/routing/conf/routing/config.pb.txt“存在的意义了。这里面配置了上面提到的这些动作的惩罚基数而这些基数会影响路线时的计算代价。
routing的请求接口是下面这个
bool Routing::Process(const std::shared_ptrRoutingRequest routing_request, RoutingResponse* const routing_response);这个接口只有很简洁的两个参数一个是描述请求的输入参数routing_request一个是包含结果的输出参数routing_response。它们都是在proto文件中定义的。
2.2 RoutingRequest
message LaneWaypoint {optional string id 1;optional double s 2;optional apollo.common.PointENU pose 3;
}message LaneSegment {optional string id 1;optional double start_s 2;optional double end_s 3;
}message RoutingRequest {optional apollo.common.Header header 1;repeated LaneWaypoint waypoint 2;repeated LaneSegment blacklisted_lane 3;repeated string blacklisted_road 4;optional bool broadcast 5 [default true];optional apollo.hdmap.ParkingSpace parking_space 6;
}2.3 RoutingResponse
message RoutingResponse {optional apollo.common.Header header 1;repeated RoadSegment road 2;optional Measurement measurement 3;optional RoutingRequest routing_request 4;optional bytes map_version 5;optional apollo.common.StatusPb status 6;
}message RoadSegment {optional string id 1;repeated Passage passage 2;
}message Passage {repeated LaneSegment segment 1;optional bool can_exit 2;optional ChangeLaneType change_lane_type 3 [default FORWARD];
}message LaneSegment {optional string id 1;optional double start_s 2;optional double end_s 3;
}enum ChangeLaneType {FORWARD 0;LEFT 1;RIGHT 2;
};message Measurement {optional double distance 1;
}RoutingResponse中的属性说明如下 这里的RoadSegment road是最重要的数据。这个数据其实是一个三层的结构体嵌套它们的说明如下
RoadSegment road描述道路一条道路可能包含了并行的几条通路Passage。Passage描述通路通路是直连不含变道的可行驶区域。一个通路可能包含了前后连接的多个车道。对应了pac_map中的RouteSegmentsLaneSegment描述车道车道是道路中的一段自动驾驶车辆会尽可能沿着车道的中心线行驶。 3. pnc_map
pnc全称是Planning And Control是Planning用来对接Routing搜索结果的子模块但他比较重要这里我把它单独拎出来梳理下。
PncMap类负责对接Routing搜索结果的更新会根据车辆当前位置提供车辆周边的RouteSegments信息供ReferenceLineProvider生成ReferenceLine。而这里的RouteSegments对应了routing模块里RoutingResponse里的Passage结构它其中会包含若干个车道信息。这个RouteSegments类继承自std::vector。RouteSegments中有如下一些方法值得关注
NextAction()车辆接下来要采取的动作。可能是直行左变道或者右变道。CanExit()当前通路是否可以接续到Routing结果的另外一个通路上。GetProjection()将一个点投影到当前通路上。返回SLPoint和LaneWaypoint。Stitch()缝合另外一个RouteSegments。即去除两个RouteSegments间重合的多余部分然后连接起来。Shrink()缩短到指定范围。IsOnSegment()车辆是否在当前RouteSegments上。IsNeighborSegment()当前RouteSegments是否是车辆的临近RouteSegments。 4. planning
在Planning模块中有以下三个数据结构将是本文关注的重点
ReferenceLine原始参考线源码位于planning/reference_line/目录下。根据Routing的搜索结果生成。ReferenceLineInfo源码位于planning/reference_line/目录下。Planning实现中逻辑计算的基础数据结构很多操作都会在这个数据结构上进行例如交通规则逻辑障碍物投影路径优化速度决策等。本文中的“参考线”一词将不区分ReferenceLine和ReferenceLineInfo两个结构。Trajectory下文中我们将看到有好几个结构用来描述轨迹。它们在不同的场合下使用。这其中ADCTrajectory是Planning模块的输出。它是Planning模块一次计算循环中处理了所有逻辑的最终结果包含了车辆行驶需要的所有信息。因此这个数据将直接影响到自动驾驶车辆的行车行为。 5. reference
解析百度Apollo之Routing模块 解析百度Apollo之参考线与轨迹 开发者说丨离散点曲线平滑原理 直播回顾丨Apollo自动驾驶论坛①规划模块算法解析 Apollo Planning Frame Apollo ReferenceLineProvider Apollo EMPlanner(v 3.0) Apollo 6.0 规划算法解析 Apollo 6.0 规划模块算法解析2
