WPILibC++ 2025.0.0-alpha-1-24-g6478ba6
AngleStatistics.h File Reference
#include <functional>
#include <numbers>
#include "frc/EigenCore.h"
#include "frc/MathUtil.h"

Go to the source code of this file.

Namespaces

namespace  frc
 

Functions

template<int States>
Vectord< States > frc::AngleResidual (const Vectord< States > &a, const Vectord< States > &b, int angleStateIdx)
 Subtracts a and b while normalizing the resulting value in the selected row as if it were an angle. More...
 
template<int States>
std::function< Vectord< States >(const Vectord< States > &, const Vectord< States > &)> frc::AngleResidual (int angleStateIdx)
 Returns a function that subtracts two vectors while normalizing the resulting value in the selected row as if it were an angle. More...
 
template<int States>
Vectord< States > frc::AngleAdd (const Vectord< States > &a, const Vectord< States > &b, int angleStateIdx)
 Adds a and b while normalizing the resulting value in the selected row as an angle. More...
 
template<int States>
std::function< Vectord< States >(const Vectord< States > &, const Vectord< States > &)> frc::AngleAdd (int angleStateIdx)
 Returns a function that adds two vectors while normalizing the resulting value in the selected row as an angle. More...
 
template<int CovDim, int States>
Vectord< CovDim > frc::AngleMean (const Matrixd< CovDim, 2 *States+1 > &sigmas, const Vectord< 2 *States+1 > &Wm, int angleStatesIdx)
 Computes the mean of sigmas with the weights Wm while computing a special angle mean for a select row. More...
 
template<int CovDim, int States>
std::function< Vectord< CovDim >(const Matrixd< CovDim, 2 *States+1 > &, const Vectord< 2 *States+1 > &)> frc::AngleMean (int angleStateIdx)
 Returns a function that computes the mean of sigmas with the weights Wm while computing a special angle mean for a select row. More...