Carma-platform v4.2.0
CARMA Platform is built on robot operating system (ROS) and utilizes open source software (OSS) that enables Cooperative Driving Automation (CDA) features to allow Automated Driving Systems to interact and cooperate with infrastructure and other vehicles through communication.
fixed_priority_cost_function.hpp
Go to the documentation of this file.
1/*
2 * Copyright (C) 2022 LEIDOS.
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License"); you may not
5 * use this file except in compliance with the License. You may obtain a copy of
6 * the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
12 * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
13 * License for the specific language governing permissions and limitations under
14 * the License.
15 */
16
17#ifndef __ARBITRATOR_INCLUDE_FIXED_PRIORITY_COST_FUNCTION_HPP__
18#define __ARBITRATOR_INCLUDE_FIXED_PRIORITY_COST_FUNCTION_HPP__
19
20#include "cost_function.hpp"
21#include <map>
22#include <string>
23
24namespace arbitrator
25{
38 {
39 public:
44 FixedPriorityCostFunction(const std::map<std::string, double> &plugin_priorities);
45
51 double compute_total_cost(const carma_planning_msgs::msg::ManeuverPlan& plan);
52
58 double compute_cost_per_unit_distance(const carma_planning_msgs::msg::ManeuverPlan& plan);
59 private:
60 std::map<std::string, double> plugin_costs_;
61 };
62}
63
64#endif //__ARBITRATOR_INCLUDE_FIXED_PRIORITY_COST_FUNCTION_HPP__
Generic interface representing a means of computing cost for plans in the search graph.
Implementation of the CostFunction interface.
double compute_total_cost(const carma_planning_msgs::msg::ManeuverPlan &plan)
Compute the unit cost over distance of a given maneuver plan.
FixedPriorityCostFunction(const std::map< std::string, double > &plugin_priorities)
Constructor for FixedPriorityCostFunction.
double compute_cost_per_unit_distance(const carma_planning_msgs::msg::ManeuverPlan &plan)
Compute the unit cost over distance of a given maneuver plan.