Function calc_angle_to_next

• Defined in File calculate_costs.hpp

Function Documentation

arma::mat calc_angle_to_next(const arma::mat &points_xy, const arma::imat &configurations)

Computes angles between sequences of three consecutive cones.

Parameters:

• points_xy – Matrix of cone 2D coordinates.

• configurations – Matrix of cone index configurations.

Returns:

Matrix of angles for each configuration.