2#include "../core/include/utils/geometry.h"
14double clamp(
double value,
double low,
double high);
22double lerp(
double a,
double b,
double t);
31double wrap_angle_deg(
double input);
32double wrap_angle_rad(
double input);
40double variance(std::vector<double>
const &values,
double mean);
46double mean(std::vector<double>
const &values);
56double covariance(std::vector<std::pair<double, double>>
const &points,
double meanx,
double meany);
62std::pair<double, double> calculate_linear_regression(std::vector<std::pair<double, double>>
const &points);
64double estimate_path_length(
const std::vector<point_t> &points);