GaussianFactor.h

Go to the documentation of this file.

/* ----------------------------------------------------------------------------
 
 * GTSAM Copyright 2010, Georgia Tech Research Corporation,
 * Atlanta, Georgia 30332-0415
 * All Rights Reserved
 * Authors: Frank Dellaert, et al. (see THANKS for the full author list)
 
 * See LICENSE for the license information
 
 * -------------------------------------------------------------------------- */
 
// \callgraph
 
#pragma once
 
#include <gtsam/inference/Factor.h>
#include <gtsam/base/Matrix.h>
#include <gtsam/base/Testable.h>
 
namespace gtsam {
 
  // Forward declarations
  class VectorValues;
  class Scatter;
  class SymmetricBlockMatrix;
 
  class GTSAM_EXPORT GaussianFactor : public Factor
  {
  public:
    typedef GaussianFactor This; 
    typedef std::shared_ptr<This> shared_ptr; 
    typedef Factor Base; 
 
 
    GaussianFactor() {}
 
    template<typename CONTAINER>
    GaussianFactor(const CONTAINER& keys) : Base(keys) {}
 
 
    void print(
        const std::string& s = "",
        const KeyFormatter& formatter = DefaultKeyFormatter) const override = 0;
 
    virtual bool equals(const GaussianFactor& lf, double tol = 1e-9) const = 0;
 
 
    virtual double error(const VectorValues& c) const;
 
    double error(const HybridValues& c) const override;
 
    virtual DenseIndex getDim(const_iterator variable) const = 0;
 
    virtual Matrix augmentedJacobian() const = 0;
 
    virtual std::pair<Matrix,Vector> jacobian() const = 0;
 
    virtual Matrix augmentedInformation() const = 0;
 
    virtual Matrix information() const = 0;
 
    VectorValues hessianDiagonal() const;
 
    virtual void hessianDiagonalAdd(VectorValues& d) const = 0;
 
    virtual void hessianDiagonal(double* d) const = 0;
 
    virtual std::map<Key,Matrix> hessianBlockDiagonal() const = 0;
 
    virtual GaussianFactor::shared_ptr clone() const = 0;
 
    virtual GaussianFactor::shared_ptr negate() const = 0;
 
    virtual void updateHessian(const KeyVector& keys,
                           SymmetricBlockMatrix* info) const = 0;
 
 
    virtual void multiplyHessianAdd(double alpha, const VectorValues& x, VectorValues& y) const = 0;
 
    virtual VectorValues gradientAtZero() const = 0;
 
    virtual void gradientAtZero(double* d) const = 0;
 
    virtual Vector gradient(Key key, const VectorValues& x) const = 0;
 
 
    // Determine position of a given key
    template <typename CONTAINER>
    static DenseIndex Slot(const CONTAINER& keys, Key key) {
      return std::find(keys.begin(), keys.end(), key) - keys.begin();
    }
 
    
  private:
#ifdef GTSAM_ENABLE_BOOST_SERIALIZATION
 
    friend class boost::serialization::access;
    template<class ARCHIVE>
    void serialize(ARCHIVE & ar, const unsigned int /*version*/) {
      ar & BOOST_SERIALIZATION_BASE_OBJECT_NVP(Base);
    }
#endif
  }; // GaussianFactor
 
template<>
struct traits<GaussianFactor> : public Testable<GaussianFactor> {
};
 
} // \ namespace gtsam