Function calc_cones_on_either_cost

• Defined in File calculate_costs.hpp

Function Documentation

arma::fvec calc_cones_on_either_cost(const arma::mat &points_xy, const arma::imat &configurations, ConeType cone_type)

Calculates a cost based on the distribution of cones on either side of the intended path.

Parameters:

• points_xy – Matrix of cone 2D coordinates.

• configurations – Matrix of cone index configurations.

• cone_type – Type of cones (LEFT or RIGHT).

Returns:

Vector of costs based on cone side distribution for each configuration.