multi_agent_evaluator.h

浏览该文件的文档.

/******************************************************************************
 * Copyright 2021 The Apollo Authors. All Rights Reserved.
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 * http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *****************************************************************************/
 
#pragma once
 
#include <string>
#include <utility>
#include <vector>
 
#include "torch/extension.h"
#include "torch/script.h"
#include "modules/prediction/evaluator/evaluator.h"
#include "modules/prediction/evaluator/model_manager/model_manager.h"
#include "modules/prediction/pipeline/vector_net.h"
#include "modules/prediction/container/adc_trajectory/adc_trajectory_container.h"
 
namespace apollo {
namespace prediction {
 
using apollo::common::TrajectoryPoint;
 
class MultiAgentEvaluator : public Evaluator {
 public:
  MultiAgentEvaluator();
 
  virtual ~MultiAgentEvaluator() = default;
 
  void Clear();
 
  bool VectornetProcessObstaclePosition(
    ObstaclesContainer* obstacles_container,
    const ADCTrajectoryContainer* adc_trajectory_container,
    std::vector<int>& prediction_obs_ids,
    torch::Tensor* ptr_multi_obstacle_pos,
    torch::Tensor* ptr_multi_obstacle_pos_step,
    torch::Tensor* ptr_vector_mask,
    torch::Tensor* ptr_all_obs_data,
    torch::Tensor* ptr_all_obs_p_id,
    torch::Tensor* ptr_multi_obstacle_position);
 
  bool VectornetProcessMapData(FeatureVector *map_feature,
                               PidVector *map_p_id,
                               const int obs_num,
                               torch::Tensor* ptr_map_data,
                               torch::Tensor* ptr_all_map_p_id,
                               torch::Tensor* ptr_vector_mask);
 
  bool Evaluate(Obstacle* obstacle, ObstaclesContainer* obstacles_container) override;
 
  bool Evaluate(const ADCTrajectoryContainer* adc_trajectory_container,
                Obstacle* obstacle,
                ObstaclesContainer* obstacles_container) override;
 
  bool ExtractObstaclesHistory(
    ObstaclesContainer* obstacles_container,
    std::vector<int>& prediction_obs_ids,
    std::vector<TrajectoryPoint>* trajectory_points,
    std::vector<std::vector<std::pair<double, double>>>* multi_obs_pos,
    std::vector<std::vector<double>>* multi_obs_position,
    std::vector<std::pair<double, double>>* all_obs_length,
    std::vector<std::vector<std::pair<double, double>>>* all_obs_pos_history,
    std::vector<std::pair<double, double>>* adc_traj_curr_pos,
    torch::Tensor* vector_mask);
 
  std::string GetName() override { return "MULTI_AGENT_EVALUATOR"; }
 
 private:
  void LoadModel();
 
 private:
  int max_agent_num = 50;
  int obs_num = 0;
  int vector_obs_num = 0;
  bool with_planning_traj = true;
  ModelManager model_manager_;
  at::Tensor torch_default_output_tensor_;
  Model::Backend device_;
  VectorNet vector_net_;
};
 
}  // namespace prediction
}  // namespace apollo