#include <numbers>
#include "frc/EigenCore.h"
#include "frc/MathUtil.h"
Go to the source code of this file.
|
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...
|
|