#include <pull_over_scenario.h>

类 apollo::planning::PullOverScenario 继承关系图:

apollo::planning::PullOverScenario 的协作图:

Public 成员函数
bool	Init (std::shared_ptr< DependencyInjector > injector, const std::string &name) override

PullOverContext *	GetContext () override
	Get the scenario context.

bool	IsTransferable (const Scenario *other_scenario, const Frame &frame) override
	Each scenario should define its own transfer condition, i.e., when it should allow to transfer from other scenario to itself.

bool	Exit (Frame *frame) override

bool	Enter (Frame *frame) override

Public 成员函数继承自 apollo::planning::Scenario
	Scenario ()

virtual	~Scenario ()=default

virtual ScenarioResult	Process (const common::TrajectoryPoint &planning_init_point, Frame *frame)

std::shared_ptr< Stage >	CreateStage (const StagePipeline &stage_pipeline)
	Each scenario should define its own stages object's creation scenario will call stage's Stage::Process function following a configured order, The return value of Stage::Process function determines the transition from one stage to another.

const ScenarioStatusType &	GetStatus () const

const std::string	GetStage () const

const std::string &	GetMsg () const

const std::string &	Name () const

void	Reset ()
	Reset the scenario, used before entering the scenario.

额外继承的成员函数
Protected 成员函数继承自 apollo::planning::Scenario
template<typename T >
bool	LoadConfig (T *config)

Protected 属性继承自 apollo::planning::Scenario
ScenarioResult	scenario_result_

std::shared_ptr< Stage >	current_stage_

std::unordered_map< std::string, const StagePipeline * >	stage_pipeline_map_

std::string	msg_

std::shared_ptr< DependencyInjector >	injector_

std::string	config_path_

std::string	config_dir_

std::string	name_

ScenarioPipeline	scenario_pipeline_config_

详细描述

在文件 pull_over_scenario.h 第 36 行定义.

成员函数说明

◆ Enter()

bool apollo::planning::PullOverScenario::Enter ( Frame * frame )

overridevirtual

重载 apollo::planning::Scenario .

在文件 pull_over_scenario.cc 第 171 行定义.

                                         {
  auto* pull_over = injector_->planning_context()
                        ->mutable_planning_status()
                        ->mutable_pull_over();
  pull_over->set_pull_over_type(PullOverStatus::PULL_OVER);
  pull_over->set_plan_pull_over_path(true);
  return true;
}

◆ Exit()

bool apollo::planning::PullOverScenario::Exit ( Frame * frame )

overridevirtual

重载 apollo::planning::Scenario .

在文件 pull_over_scenario.cc 第 166 行定义.

                                        {
  injector_->planning_context()->mutable_planning_status()->clear_pull_over();
  return true;
}

◆ GetContext()

PullOverContext * apollo::planning::PullOverScenario::GetContext ( )

inlineoverridevirtual

Get the scenario context.

实现了 apollo::planning::Scenario.

在文件 pull_over_scenario.h 第 44 行定义.

44{ return &context_; }

◆ Init()

bool apollo::planning::PullOverScenario::Init	(	std::shared_ptr< DependencyInjector >	injector,
		const std::string &	name
	)

overridevirtual

重载 apollo::planning::Scenario .

在文件 pull_over_scenario.cc 第 34 行定义.

                                                   {
  if (init_) {
    return true;
  }
 
  if (!Scenario::Init(injector, name)) {
    AERROR << "failed to init scenario" << Name();
    return false;
  }
 
  if (!Scenario::LoadConfig<ScenarioPullOverConfig>(
          &context_.scenario_config)) {
    AERROR << "fail to get config of scenario" << Name();
    return false;
  }
 
  init_ = true;
  return true;
}

◆ IsTransferable()

bool apollo::planning::PullOverScenario::IsTransferable	(	const Scenario *	other_scenario,
		const Frame &	frame
	)

overridevirtual

Each scenario should define its own transfer condition, i.e., when it should allow to transfer from other scenario to itself.

重载 apollo::planning::Scenario .

在文件 pull_over_scenario.cc 第 55 行定义.

                                                          {
  if (!frame.local_view().planning_command->has_lane_follow_command()) {
    return false;
  }
  if (other_scenario == nullptr || frame.reference_line_info().empty()) {
    return false;
  }
  if (!FLAGS_enable_pull_over_at_destination) {
    return false;
  }
  const auto routing_end = frame.local_view().end_lane_way_point;
  if (nullptr == routing_end) {
    return false;
  }
  common::SLPoint dest_sl;
  const auto& reference_line_info = frame.reference_line_info().front();
  const auto& reference_line = reference_line_info.reference_line();
  reference_line.XYToSL(routing_end->pose(), &dest_sl);
  if (!reference_line.IsOnLane(dest_sl)) {
    return false;
  }
  const double adc_front_edge_s = reference_line_info.AdcSlBoundary().end_s();
 
  const double adc_distance_to_dest = dest_sl.s() - adc_front_edge_s;
  ADEBUG << "adc_distance_to_dest[" << adc_distance_to_dest
         << "] destination_s[" << dest_sl.s() << "] adc_front_edge_s["
         << adc_front_edge_s << "]";
 
  bool pull_over_scenario =
      (frame.reference_line_info().size() == 1 &&  // NO, while changing lane
       adc_distance_to_dest >=
           context_.scenario_config.pull_over_min_distance_buffer() &&
       adc_distance_to_dest <=
           context_.scenario_config.start_pull_over_scenario_distance());
  // too close to destination + not found pull-over position
  if (pull_over_scenario) {
    if (adc_distance_to_dest <
        context_.scenario_config.max_distance_stop_search()) {
      pull_over_scenario = false;
    }
  }
  // check around junction
  auto first_encountered_overlaps =
      frame.reference_line_info().front().FirstEncounteredOverlaps();
  if (pull_over_scenario) {
    static constexpr double kDistanceToAvoidJunction = 8.0;  // meter
    for (const auto& overlap : first_encountered_overlaps) {
      if (overlap.first == ReferenceLineInfo::PNC_JUNCTION ||
          overlap.first == ReferenceLineInfo::SIGNAL ||
          overlap.first == ReferenceLineInfo::STOP_SIGN ||
          overlap.first == ReferenceLineInfo::YIELD_SIGN) {
        const double distance_to = overlap.second.start_s - dest_sl.s();
        const double distance_passed = dest_sl.s() - overlap.second.end_s;
        if ((distance_to > 0.0 && distance_to < kDistanceToAvoidJunction) ||
            (distance_passed > 0.0 &&
             distance_passed < kDistanceToAvoidJunction)) {
          pull_over_scenario = false;
          break;
        }
      }
    }
  }
 
  // check rightmost driving lane along pull-over path
  if (pull_over_scenario) {
    double check_s = adc_front_edge_s;
    static constexpr double kDistanceUnit = 5.0;
    while (check_s < dest_sl.s()) {
      check_s += kDistanceUnit;
 
      std::vector<hdmap::LaneInfoConstPtr> lanes;
      reference_line.GetLaneFromS(check_s, &lanes);
      if (lanes.empty()) {
        ADEBUG << "check_s[" << check_s << "] can't find a lane";
        continue;
      }
      const hdmap::LaneInfoConstPtr lane = lanes[0];
      const std::string lane_id = lane->lane().id().id();
      ADEBUG << "check_s[" << check_s << "] lane[" << lane_id << "]";
 
      // check neighbor lanes type: NONE/CITY_DRIVING/BIKING/SIDEWALK/PARKING
      bool rightmost_driving_lane = true;
      for (const auto& neighbor_lane_id :
           lane->lane().right_neighbor_forward_lane_id()) {
        const auto hdmap_ptr = HDMapUtil::BaseMapPtr();
        CHECK_NOTNULL(hdmap_ptr);
        const auto neighbor_lane = hdmap_ptr->GetLaneById(neighbor_lane_id);
        if (neighbor_lane == nullptr) {
          AWARN << "Failed to find neighbor lane[" << neighbor_lane_id.id()
                << "]";
          continue;
        }
        const auto& lane_type = neighbor_lane->lane().type();
        if (lane_type == hdmap::Lane::CITY_DRIVING) {
          AWARN << "lane[" << lane_id << "]'s right neighbor forward lane["
                << neighbor_lane_id.id() << "] type["
                << Lane_LaneType_Name(lane_type) << "] can't pull over";
          rightmost_driving_lane = false;
          break;
        }
      }
      if (!rightmost_driving_lane) {
        pull_over_scenario = false;
        break;
      }
    }
  }
  return pull_over_scenario;
}

该类的文档由以下文件生成:

modules/planning/scenarios/pull_over/pull_over_scenario.h
modules/planning/scenarios/pull_over/pull_over_scenario.cc

Public 成员函数

额外继承的成员函数

详细描述

成员函数说明

◆ Enter()

◆ Exit()

◆ GetContext()

◆ Init()

◆ IsTransferable()