Apollo 10.0
自动驾驶开放平台
apollo::planning::EmergencyPullOverStageApproach类 参考

#include <stage_approach.h>

类 apollo::planning::EmergencyPullOverStageApproach 继承关系图:
apollo::planning::EmergencyPullOverStageApproach 的协作图:

Public 成员函数

StageResult Process (const common::TrajectoryPoint &planning_init_point, Frame *frame) override
 Each stage does its business logic inside Process function.
 
- Public 成员函数 继承自 apollo::planning::Stage
 Stage ()
 
virtual bool Init (const StagePipeline &config, const std::shared_ptr< DependencyInjector > &injector, const std::string &config_dir, void *context)
 
virtual ~Stage ()=default
 
const std::string & Name () const
 
template<typename T >
T * GetContextAs () const
 
const std::string & NextStage () const
 

额外继承的成员函数

- Protected 成员函数 继承自 apollo::planning::Stage
StageResult ExecuteTaskOnReferenceLine (const common::TrajectoryPoint &planning_start_point, Frame *frame)
 
StageResult ExecuteTaskOnReferenceLineForOnlineLearning (const common::TrajectoryPoint &planning_start_point, Frame *frame)
 
StageResult ExecuteTaskOnOpenSpace (Frame *frame)
 
virtual StageResult FinishScenario ()
 
void RecordDebugInfo (ReferenceLineInfo *reference_line_info, const std::string &name, const double time_diff_ms)
 
- Protected 属性 继承自 apollo::planning::Stage
std::vector< std::shared_ptr< Task > > task_list_
 
std::shared_ptr< Taskfallback_task_
 
std::string next_stage_
 
void * context_
 
std::shared_ptr< DependencyInjectorinjector_
 
StagePipeline pipeline_config_
 

详细描述

在文件 stage_approach.h35 行定义.

成员函数说明

◆ Process()

StageResult apollo::planning::EmergencyPullOverStageApproach::Process ( const common::TrajectoryPoint planning_init_point,
Frame frame 
)
overridevirtual

Each stage does its business logic inside Process function.

If the stage want to transit to a different stage after finish, it should set the type of 'next_stage_'.

实现了 apollo::planning::Stage.

在文件 stage_approach.cc40 行定义.

41 {
42 ADEBUG << "stage: Approach";
43 CHECK_NOTNULL(frame);
44 auto scenario_context = GetContextAs<EmergencyPullOverContext>();
45 const auto& scenario_config = scenario_context->scenario_config;
46
47 auto& reference_line_info = frame->mutable_reference_line_info()->front();
48 reference_line_info.LimitCruiseSpeed(
49 scenario_context->target_slow_down_speed);
50 // set vehicle signal
51 reference_line_info.SetTurnSignal(VehicleSignal::TURN_RIGHT);
52
53 double stop_line_s = 0.0;
54
55 // add a stop fence
56 const auto& pull_over_status =
57 injector_->planning_context()->planning_status().pull_over();
58 if (pull_over_status.has_position() && pull_over_status.position().has_x() &&
59 pull_over_status.position().has_y()) {
60 const auto& reference_line = reference_line_info.reference_line();
61 common::SLPoint pull_over_sl;
62 reference_line.XYToSL(pull_over_status.position(), &pull_over_sl);
63 const double stop_distance = scenario_config.stop_distance();
64 stop_line_s =
65 pull_over_sl.s() + stop_distance +
67 const std::string virtual_obstacle_id = "EMERGENCY_PULL_OVER";
68 const std::vector<std::string> wait_for_obstacle_ids;
70 virtual_obstacle_id, stop_line_s, stop_distance,
71 StopReasonCode::STOP_REASON_PULL_OVER, wait_for_obstacle_ids,
72 "EMERGENCY_PULL_OVER-scenario", frame,
73 &(frame->mutable_reference_line_info()->front()));
74
75 ADEBUG << "Build a stop fence for emergency_pull_over: id["
76 << virtual_obstacle_id << "] s[" << stop_line_s << "]";
77 }
78
79 StageResult result = ExecuteTaskOnReferenceLine(planning_init_point, frame);
80 if (result.HasError()) {
81 AERROR << "EmergencyPullOverStageApproach planning error";
82 }
83
84 if (stop_line_s > 0.0) {
85 const double adc_front_edge_s = reference_line_info.AdcSlBoundary().end_s();
86 double distance = stop_line_s - adc_front_edge_s;
87 const double adc_speed = injector_->vehicle_state()->linear_velocity();
88 const double max_adc_stop_speed = common::VehicleConfigHelper::Instance()
89 ->GetConfig()
90 .vehicle_param()
91 .max_abs_speed_when_stopped();
92 ADEBUG << "adc_speed[" << adc_speed << "] distance[" << distance << "]";
93 static constexpr double kStopSpeedTolerance = 0.4;
94 static constexpr double kStopDistanceTolerance = 3.0;
95 if (adc_speed <= max_adc_stop_speed + kStopSpeedTolerance &&
96 std::fabs(distance) <= kStopDistanceTolerance) {
97 return FinishStage();
98 }
99 }
100
101 return result.SetStageStatus(StageStatusType::RUNNING);
102}
static const VehicleConfig & GetConfig()
Get the current vehicle configuration.
std::shared_ptr< DependencyInjector > injector_
Definition stage.h:91
StageResult ExecuteTaskOnReferenceLine(const common::TrajectoryPoint &planning_start_point, Frame *frame)
Definition stage.cc:101
#define ADEBUG
Definition log.h:41
#define AERROR
Definition log.h:44
int BuildStopDecision(const std::string &stop_wall_id, const double stop_line_s, const double stop_distance, const StopReasonCode &stop_reason_code, const std::vector< std::string > &wait_for_obstacles, const std::string &decision_tag, Frame *const frame, ReferenceLineInfo *const reference_line_info, double stop_wall_width)
Definition common.cc:28
optional VehicleParam vehicle_param

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