Go to the documentation of this file.
5 template <
typename Scalar>
27 for (k = 0; k <
n; ++k)
28 if (
abs(r(k,k)) > tolr) {
30 for (
j = 0;
j <= k-1; ++
j) {
31 temp = r(k,k) * r(
j,k);
33 r.col(k).head(
j+1) -= r.col(
j).head(
j+1) * temp;
40 for (k = 0; k <=
l; ++k) {
41 for (
j = 0;
j <= k-1; ++
j)
42 r.col(
j).head(
j+1) += r.col(k).head(
j+1) * r(
j,k);
43 r.col(k).head(k+1) *= r(k,k);
48 for (
j = 0;
j <
n; ++
j) {
51 for (
i = 0;
i <=
j; ++
i) {
64 r.topLeftCorner(
n,
n).template triangularView<StrictlyUpper>() = r.topLeftCorner(
n,
n).transpose();
Namespace containing all symbols from the Eigen library.
static const Line3 l(Rot3(), 1, 1)
void covar(Matrix< Scalar, Dynamic, Dynamic > &r, const VectorXi &ipvt, Scalar tol=std::sqrt(NumTraits< Scalar >::epsilon()))
EIGEN_DEVICE_FUNC EIGEN_STRONG_INLINE EIGEN_CONSTEXPR Index cols() const EIGEN_NOEXCEPT
EIGEN_DEFAULT_DENSE_INDEX_TYPE DenseIndex
Jet< T, N > sqrt(const Jet< T, N > &f)
EIGEN_DEFAULT_DENSE_INDEX_TYPE Index
The Index type as used for the API.
gtsam
Author(s):
autogenerated on Fri Nov 1 2024 03:32:18