WPILibC++ 2024.3.2
AngleStatistics.h File Reference
#include <functional>
#include <numbers>
#include "frc/EigenCore.h"
#include "frc/MathUtil.h"

Go to the source code of this file.

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...