Function calculate_search_direction

Defined in File functional_cone_matching.hpp

Function Documentation

arma::fmat calculate_search_direction(const arma::fmat &cones, ConeType cone_type)

Calculates the search direction for all cones on one side of the track.

This function computes the search direction for all cones on a given side of the track. The direction is computed between consecutive cones, with special cases for the first and last cone.

Parameters:

cones – A matrix of cone positions (N x 2).
cone_type – The type of cone (LEFT or RIGHT).

Returns:

A matrix of search directions (N x 2).