apollo::prediction::MoveSequencePredictor类 参考

#include <move_sequence_predictor.h>

类 apollo::prediction::MoveSequencePredictor 继承关系图:

apollo::prediction::MoveSequencePredictor 的协作图:

Public 成员函数
	MoveSequencePredictor ()
	Constructor
virtual	~MoveSequencePredictor ()=default
	Destructor
bool	Predict (const ADCTrajectoryContainer *adc_trajectory_container, Obstacle *obstacle, ObstaclesContainer *obstacles_container) override
	Make prediction
	FRIEND_TEST (MoveSequencePredictorTest, Polynomial)
	FRIEND_TEST (MoveSequencePredictorTest, Utils)
Public 成员函数 继承自 apollo::prediction::SequencePredictor
	SequencePredictor ()=default
	Constructor
virtual	~SequencePredictor ()=default
	Destructor
bool	Predict (const ADCTrajectoryContainer *adc_trajectory_container, Obstacle *obstacle, ObstaclesContainer *obstacles_container) override
	Make prediction
	FRIEND_TEST (SequencePredictorTest, General)
Public 成员函数 继承自 apollo::prediction::Predictor
	Predictor ()=default
	Constructor
virtual	~Predictor ()=default
	Destructor
int	NumOfTrajectories (const Obstacle &obstacle)
	Get trajectory size
void	TrimTrajectories (const ADCTrajectoryContainer &adc_trajectory_container, Obstacle *obstacle)
	Trim prediction trajectories by adc trajectory
const ObstacleConf::PredictorType &	predictor_type ()
	get the predictor type

额外继承的成员函数
Public 类型 继承自 apollo::prediction::SequencePredictor
enum class	LaneChangeType {   LEFT , RIGHT , STRAIGHT , ONTO_LANE ,   INVALID }
Protected 成员函数 继承自 apollo::prediction::SequencePredictor
bool	GetLongitudinalPolynomial (const Obstacle &obstacle, const LaneSequence &lane_sequence, const std::pair< double, double > &lon_end_state, std::array< double, 5 > *coefficients)
bool	GetLateralPolynomial (const Obstacle &obstacle, const LaneSequence &lane_sequence, const double time_to_end_state, std::array< double, 4 > *coefficients)
void	FilterLaneSequences (const Feature &feature, const std::string &lane_id, const Obstacle *ego_vehicle_ptr, const ADCTrajectoryContainer *adc_trajectory_container, std::vector< bool > *enable_lane_sequence)
	Filter lane sequences
LaneChangeType	GetLaneChangeType (const std::string &lane_id, const LaneSequence &lane_sequence)
	Get lane change type
double	GetLaneChangeDistanceWithADC (const LaneSequence &lane_sequence, const Obstacle *ego_vehicle_ptr, const ADCTrajectoryContainer *adc_trajectory_container)
	Get lane change distance with ADC
void	DrawConstantAccelerationTrajectory (const Obstacle &obstacle, const LaneSequence &lane_sequence, const double total_time, const double period, const double acceleration, std::vector< apollo::common::TrajectoryPoint > *points)
	Draw constant acceleration trajectory points
double	GetLaneSequenceCurvatureByS (const LaneSequence &lane_sequence, const double s)
	Get lane sequence curvature by s
void	Clear ()
	Clear private members
std::string	ToString (const LaneSequence &sequence)
	Convert a lane sequence to string
Protected 成员函数 继承自 apollo::prediction::Predictor
void	SetEqualProbability (const double probability, const int start_index, Obstacle *obstacle_ptr)
	Set equal probability to prediction trajectories
bool	TrimTrajectory (const ADCTrajectoryContainer &adc_trajectory_container, Obstacle *obstacle, Trajectory *trajectory)
	Trim a single prediction trajectory, keep the portion that is not in junction.
bool	SupposedToStop (const Feature &feature, const double stop_distance, double *acceleration)
	Determine if an obstacle is supposed to stop within a distance
静态 Protected 成员函数 继承自 apollo::prediction::Predictor
static Trajectory	GenerateTrajectory (const std::vector< apollo::common::TrajectoryPoint > &points)
	Generate trajectory from trajectory points
Protected 属性 继承自 apollo::prediction::Predictor
ObstacleConf::PredictorType	predictor_type_

详细描述

在文件 move_sequence_predictor.h 第 33 行定义.

构造及析构函数说明

MoveSequencePredictor()

apollo::prediction::MoveSequencePredictor::MoveSequencePredictor

(

)

Constructor

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

                                             {
  predictor_type_ = ObstacleConf::MOVE_SEQUENCE_PREDICTOR;
}

~MoveSequencePredictor()

virtual apollo::prediction::MoveSequencePredictor::~MoveSequencePredictor ( )

virtualdefault

Destructor

成员函数说明

FRIEND_TEST() [1/2]

apollo::prediction::MoveSequencePredictor::FRIEND_TEST	(	MoveSequencePredictorTest	,
		Polynomial
	)

FRIEND_TEST() [2/2]

apollo::prediction::MoveSequencePredictor::FRIEND_TEST	(	MoveSequencePredictorTest	,
		Utils
	)

Predict()

bool apollo::prediction::MoveSequencePredictor::Predict ( const ADCTrajectoryContainer *  adc_trajectory_container, Obstacle *  obstacle, ObstaclesContainer *  obstacles_container  )

overridevirtual

Make prediction

参数

ADC	trajectory container
Obstacle	pointer
Obstacles	container

返回

If predicted successfully

实现了 apollo::prediction::Predictor.

在文件 move_sequence_predictor.cc 第 38 行定义.

                                             {
  Clear();
 
  CHECK_NOTNULL(obstacle);
  CHECK_GT(obstacle->history_size(), 0U);
 
  obstacle->SetPredictorType(predictor_type_);
 
  const Feature& feature = obstacle->latest_feature();
 
  if (!feature.has_lane() || !feature.lane().has_lane_graph()) {
    AERROR << "Obstacle [" << obstacle->id() << "] has no lane graph.";
    return false;
  }
 
  std::string lane_id = "";
  if (feature.lane().has_lane_feature()) {
    lane_id = feature.lane().lane_feature().lane_id();
  }
  int num_lane_sequence = feature.lane().lane_graph().lane_sequence_size();
  std::vector<bool> enable_lane_sequence(num_lane_sequence, true);
  Obstacle* ego_vehicle_ptr =
      obstacles_container->GetObstacle(FLAGS_ego_vehicle_id);
  FilterLaneSequences(feature, lane_id, ego_vehicle_ptr,
                      adc_trajectory_container, &enable_lane_sequence);
  for (int i = 0; i < num_lane_sequence; ++i) {
    const LaneSequence& sequence = feature.lane().lane_graph().lane_sequence(i);
    if (sequence.lane_segment().empty() ||
        sequence.lane_segment(0).lane_point().empty()) {
      ADEBUG << "Empty lane segments.";
      continue;
    }
 
    if (!enable_lane_sequence[i]) {
      ADEBUG << "Lane sequence [" << ToString(sequence)
             << "] with probability [" << sequence.probability()
             << "] is disqualified.";
      continue;
    }
 
    ADEBUG << "Obstacle [" << obstacle->id()
           << "] will draw a lane sequence trajectory [" << ToString(sequence)
           << "] with probability [" << sequence.probability() << "].";
 
    std::vector<TrajectoryPoint> points;
    auto end_time1 = std::chrono::system_clock::now();
 
    bool is_about_to_stop = false;
    double acceleration = 0.0;
    if (sequence.has_stop_sign()) {
      double stop_distance =
          sequence.stop_sign().lane_sequence_s() - sequence.lane_s();
      is_about_to_stop = SupposedToStop(feature, stop_distance, &acceleration);
    }
 
    if (is_about_to_stop) {
      DrawConstantAccelerationTrajectory(
          *obstacle, sequence, FLAGS_prediction_trajectory_time_length,
          FLAGS_prediction_trajectory_time_resolution, acceleration, &points);
    } else {
      DrawMoveSequenceTrajectoryPoints(
          *obstacle, sequence, FLAGS_prediction_trajectory_time_length,
          FLAGS_prediction_trajectory_time_resolution, &points);
    }
    auto end_time2 = std::chrono::system_clock::now();
    std::chrono::duration<double> diff = end_time2 - end_time1;
    ADEBUG << " Time to draw trajectory: " << diff.count() * 1000 << " msec.";
 
    Trajectory trajectory = GenerateTrajectory(points);
    trajectory.set_probability(sequence.probability());
    obstacle->mutable_latest_feature()->add_predicted_trajectory()->CopyFrom(
        trajectory);
  }
  return true;
}

---

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

• modules/prediction/predictor/move_sequence/move_sequence_predictor.h
• modules/prediction/predictor/move_sequence/move_sequence_predictor.cc