13 float lerp(
float a,
float b,
float t);
19 float clampf(
float value,
float min,
float max);
constexpr double DEG_TO_RAD
constexpr double RAD_TO_DEG
Angle conversion helpers shared across robotics code.
std::tuple< double, double, double > quaternionToEuler(Eigen::Quaterniond q)
Convert a quaternion to roll, pitch, yaw in radians.
float lerp(float a, float b, float t)
Linear interpolation between a and b for parameter t.
double clampDouble(double value, double min, double max)
Clamp a double to the inclusive range [min, max].
int clampInt(int value, int min, int max)
Clamp an integer to the inclusive range [min, max].
float minimalAngleDifference(float a, float b)
Return the smallest absolute angular separation between a and b in radians.
float easeInOut(float a, float b, float t)
Cosine-smoothed interpolation between a and b for parameter t.
std::function< float(float, float, float)> InterpolationFunction
int sign(int value)
Return -1, 0, or 1 depending on the sign of value.
float clampf(float value, float min, float max)
Clamp a float to the inclusive range [min, max].
float signf(float value)
Return -1.0f, 0.0f, or 1.0f depending on the sign of value.