Function calc_distance_cost

• Defined in File calculate_costs.hpp

Function Documentation

arma::fvec calc_distance_cost(const arma::mat &points_xy, const arma::imat &configurations, double threshold_distance)

Calculates the cost based on exceeding a threshold distance between consecutive cones.

Parameters:

• points_xy – Matrix of cone 2D coordinates.

• configurations – Matrix of cone index configurations.

• threshold_distance – Maximum acceptable distance between consecutive cones.

Returns:

Vector of distance costs for each configuration.