util.h

#pragma once
 
#include "vex/vex.h"
#include "Eigen/Dense"
#include "core/math/geometry/translation2d.h"
 
#include <math.h>
#include <vector>

inline constexpr double clamp(double value, double low, double high) {
    return (value < low) ? low : (value > high) ? high : value; 
}

inline constexpr double lerp(double a, double b, double t) {
    return a * (1.0 - t) + b * t;
}

inline constexpr double sign(double x) {
    return (x > 0) - (x < 0);
}

double variance(std::vector<double> const& values, double mean);

double mean(std::vector<double> const& values);

double covariance(std::vector<std::pair<double, double>> const& points, double meanx, double meany);

std::pair<double, double> calculate_linear_regression(
    std::vector<std::pair<double, double>> const& points
);
 
double estimate_path_length(const std::vector<Translation2d>& points);