g2o
Classes | Public Types | Public Member Functions | Static Public Attributes | Protected Member Functions | Protected Attributes | List of all members
g2o::BaseMultiEdge< D, E > Class Template Reference

base class to represent an edge connecting an arbitrary number of nodes More...

#include <base_multi_edge.h>

Inheritance diagram for g2o::BaseMultiEdge< D, E >:
Inheritance graph
[legend]
Collaboration diagram for g2o::BaseMultiEdge< D, E >:
Collaboration graph
[legend]

Classes

struct  HessianHelper
 helper for mapping the Hessian memory of the upper triangular block More...
 

Public Types

typedef BaseEdge< D, E >::Measurement Measurement
 
typedef MatrixXD::MapType JacobianType
 
typedef BaseEdge< D, E >::ErrorVector ErrorVector
 
typedef BaseEdge< D, E >::InformationType InformationType
 
typedef Eigen::Map< MatrixXD, MatrixXD::Flags &Eigen::AlignedBit?Eigen::Aligned:Eigen::Unaligned > HessianBlockType
 
- Public Types inherited from g2o::BaseEdge< D, E >
typedef E Measurement
 
typedef Eigen::Matrix< double, D, 1, Eigen::ColMajor > ErrorVector
 
typedef Eigen::Matrix< double, D, D, Eigen::ColMajor > InformationType
 

Public Member Functions

 BaseMultiEdge ()
 
virtual void linearizeOplus (JacobianWorkspace &jacobianWorkspace)
 
virtual void linearizeOplus ()
 
virtual void resize (size_t size)
 
virtual bool allVerticesFixed () const
 
virtual void constructQuadraticForm ()
 
virtual void mapHessianMemory (double *d, int i, int j, bool rowMajor)
 
- Public Member Functions inherited from g2o::BaseEdge< D, E >
 BaseEdge ()
 
virtual ~BaseEdge ()
 
virtual double chi2 () const
 computes the chi2 based on the cached error value, only valid after computeError has been called. More...
 
virtual const double * errorData () const
 returns the error vector cached after calling the computeError; More...
 
virtual double * errorData ()
 
const ErrorVectorerror () const
 
ErrorVectorerror ()
 
EIGEN_STRONG_INLINE const InformationTypeinformation () const
 information matrix of the constraint More...
 
EIGEN_STRONG_INLINE InformationTypeinformation ()
 
EIGEN_STRONG_INLINE void setInformation (const InformationType &information)
 
virtual const double * informationData () const
 returns the memory of the information matrix, usable for example with a Eigen::Map<MatrixXD> More...
 
virtual double * informationData ()
 
EIGEN_STRONG_INLINE const Measurementmeasurement () const
 accessor functions for the measurement represented by the edge More...
 
virtual void setMeasurement (const Measurement &m)
 
virtual int rank () const
 
virtual void initialEstimate (const OptimizableGraph::VertexSet &, OptimizableGraph::Vertex *)
 
- Public Member Functions inherited from g2o::OptimizableGraph::Edge
 Edge ()
 
virtual ~Edge ()
 
virtual Edgeclone () const
 
virtual void computeError ()=0
 
virtual bool setMeasurementData (const double *m)
 
virtual bool getMeasurementData (double *m) const
 
virtual int measurementDimension () const
 
virtual bool setMeasurementFromState ()
 
RobustKernelrobustKernel () const
 if NOT NULL, error of this edge will be robustifed with the kernel More...
 
void setRobustKernel (RobustKernel *ptr)
 
virtual double initialEstimatePossible (const OptimizableGraph::VertexSet &from, OptimizableGraph::Vertex *to)
 
int level () const
 returns the level of the edge More...
 
void setLevel (int l)
 sets the level of the edge More...
 
int dimension () const
 returns the dimensions of the error function More...
 
 G2O_ATTRIBUTE_DEPRECATED (virtual Vertex *createFrom())
 
 G2O_ATTRIBUTE_DEPRECATED (virtual Vertex *createTo())
 
virtual VertexcreateVertex (int)
 
virtual bool read (std::istream &is)=0
 read the vertex from a stream, i.e., the internal state of the vertex More...
 
virtual bool write (std::ostream &os) const =0
 write the vertex to a stream More...
 
long long internalId () const
 the internal ID of the edge More...
 
OptimizableGraphgraph ()
 
const OptimizableGraphgraph () const
 
bool setParameterId (int argNum, int paramId)
 
const Parameterparameter (int argNo) const
 
size_t numParameters () const
 
void resizeParameters (size_t newSize)
 
- Public Member Functions inherited from g2o::HyperGraph::Edge
 Edge (int id=InvalidId)
 creates and empty edge with no vertices More...
 
const VertexContainervertices () const
 
VertexContainervertices ()
 
const Vertexvertex (size_t i) const
 
Vertexvertex (size_t i)
 
void setVertex (size_t i, Vertex *v)
 
int id () const
 
void setId (int id)
 
virtual HyperGraphElementType elementType () const
 
int numUndefinedVertices () const
 
- Public Member Functions inherited from g2o::HyperGraph::HyperGraphElement
virtual ~HyperGraphElement ()
 
HyperGraphElementclone () const
 
- Public Member Functions inherited from g2o::HyperGraph::DataContainer
 DataContainer ()
 
virtual ~DataContainer ()
 
const DatauserData () const
 the user data associated with this vertex More...
 
DatauserData ()
 
void setUserData (Data *obs)
 
void addUserData (Data *obs)
 

Static Public Attributes

static const int Dimension = BaseEdge<D,E>::Dimension
 
- Static Public Attributes inherited from g2o::BaseEdge< D, E >
static const int Dimension = D
 

Protected Member Functions

void computeQuadraticForm (const InformationType &omega, const ErrorVector &weightedError)
 
- Protected Member Functions inherited from g2o::BaseEdge< D, E >
InformationType robustInformation (const Vector3D &rho)
 
- Protected Member Functions inherited from g2o::OptimizableGraph::Edge
template<typename ParameterType >
bool installParameter (ParameterType *&p, size_t argNo, int paramId=-1)
 
template<typename CacheType >
void resolveCache (CacheType *&cache, OptimizableGraph::Vertex *, const std::string &_type, const ParameterVector &parameters)
 
bool resolveParameters ()
 
virtual bool resolveCaches ()
 

Protected Attributes

std::vector< HessianHelper_hessian
 
std::vector< JacobianType, Eigen::aligned_allocator< JacobianType > > _jacobianOplus
 jacobians of the edge (w.r.t. oplus) More...
 
- Protected Attributes inherited from g2o::BaseEdge< D, E >
Measurement _measurement
 
InformationType _information
 
ErrorVector _error
 
- Protected Attributes inherited from g2o::OptimizableGraph::Edge
int _dimension
 
int _level
 
RobustKernel_robustKernel
 
long long _internalId
 
std::vector< int > _cacheIds
 
std::vector< std::string > _parameterTypes
 
std::vector< Parameter ** > _parameters
 
std::vector< int > _parameterIds
 
- Protected Attributes inherited from g2o::HyperGraph::Edge
VertexContainer _vertices
 
int _id
 unique id More...
 
- Protected Attributes inherited from g2o::HyperGraph::DataContainer
Data_userData
 

Detailed Description

template<int D, typename E>
class g2o::BaseMultiEdge< D, E >

base class to represent an edge connecting an arbitrary number of nodes

D - Dimension of the measurement E - type to represent the measurement

Definition at line 49 of file base_multi_edge.h.

Member Typedef Documentation

template<int D, typename E>
typedef BaseEdge<D,E>::ErrorVector g2o::BaseMultiEdge< D, E >::ErrorVector

Definition at line 65 of file base_multi_edge.h.

template<int D, typename E>
typedef Eigen::Map<MatrixXD, MatrixXD::Flags & Eigen::AlignedBit ? Eigen::Aligned : Eigen::Unaligned > g2o::BaseMultiEdge< D, E >::HessianBlockType

Definition at line 67 of file base_multi_edge.h.

template<int D, typename E>
typedef BaseEdge<D,E>::InformationType g2o::BaseMultiEdge< D, E >::InformationType

Definition at line 66 of file base_multi_edge.h.

template<int D, typename E>
typedef MatrixXD::MapType g2o::BaseMultiEdge< D, E >::JacobianType

Definition at line 64 of file base_multi_edge.h.

template<int D, typename E>
typedef BaseEdge<D,E>::Measurement g2o::BaseMultiEdge< D, E >::Measurement

Definition at line 63 of file base_multi_edge.h.

Constructor & Destructor Documentation

template<int D, typename E>
g2o::BaseMultiEdge< D, E >::BaseMultiEdge ( )
inline

Definition at line 69 of file base_multi_edge.h.

69  : BaseEdge<D,E>()
70  {
71  }

Member Function Documentation

template<int D, typename E >
bool BaseMultiEdge::allVerticesFixed ( ) const
virtual

Implements g2o::OptimizableGraph::Edge.

Definition at line 161 of file base_multi_edge.h.

Referenced by g2o::BaseMultiEdge< 3, VelocityMeasurement >::BaseMultiEdge(), and g2o::BaseMultiEdge<-1, E >::BaseMultiEdge().

166  :
167  EIGEN_MAKE_ALIGNED_OPERATOR_NEW;
168  };
169 
template<int D, typename E >
void BaseMultiEdge::computeQuadraticForm ( const InformationType omega,
const ErrorVector weightedError 
)
protected

Definition at line 172 of file base_multi_edge.h.

template<int D, typename E >
void BaseMultiEdge::constructQuadraticForm ( )
virtual

Linearizes the constraint in the edge. Makes side effect on the vertices of the graph by changing the parameter vector b and the hessian blocks ii and jj. The off diagoinal block is accesed via _hessian.

Implements g2o::OptimizableGraph::Edge.

Definition at line 37 of file base_multi_edge.h.

Referenced by g2o::BaseMultiEdge< 3, VelocityMeasurement >::BaseMultiEdge(), and g2o::BaseMultiEdge<-1, E >::BaseMultiEdge().

40  {
41 
48  template <int D, typename E>
49  class BaseMultiEdge : public BaseEdge<D,E>
template<int D, typename E >
void BaseMultiEdge::linearizeOplus ( JacobianWorkspace jacobianWorkspace)
virtual

Linearizes the constraint in the edge in the manifold space, and store the result in the given workspace

Implements g2o::OptimizableGraph::Edge.

Definition at line 53 of file base_multi_edge.h.

55  {
56  Eigen::Map<MatrixXD> matrix;
57  bool transposed;
58  HessianHelper() : matrix(0, 0, 0), transposed(false) {}
59  };
60 
61  public:
template<int D, typename E >
void BaseMultiEdge::linearizeOplus ( )
virtual

Linearizes the oplus operator in the vertex, and stores the result in temporary variable vector _jacobianOplus

Reimplemented in g2o::EdgeProjectP2MC_Intrinsics, g2o::EdgeProjectPSI2UV, g2o::EdgeSE2LotsOfXY, and g2o::EdgeSE3LotsOfXYZ.

Definition at line 64 of file base_multi_edge.h.

Referenced by g2o::BaseMultiEdge< 3, VelocityMeasurement >::BaseMultiEdge(), and g2o::BaseMultiEdge<-1, E >::BaseMultiEdge().

67  : Eigen::Unaligned > HessianBlockType;
68 
69  BaseMultiEdge() : BaseEdge<D,E>()
70  {
71  }
72 
73  virtual void linearizeOplus(JacobianWorkspace& jacobianWorkspace);
74 
79  virtual void linearizeOplus();
80 
81  virtual void resize(size_t size);
82 
83  virtual bool allVerticesFixed() const;
84 
85  virtual void constructQuadraticForm() ;
86 
87  virtual void mapHessianMemory(double* d, int i, int j, bool rowMajor);
88 
90 
91  protected:
97 
98  std::vector<HessianHelper> _hessian;
99  std::vector<JacobianType, Eigen::aligned_allocator<JacobianType> > _jacobianOplus;
100 
101  void computeQuadraticForm(const InformationType& omega, const ErrorVector& weightedError);
102 
103  public:
104  EIGEN_MAKE_ALIGNED_OPERATOR_NEW
105  };
106 
107 
108 
109  // PARTIAL TEMPLATE SPECIALIZATION
110  template <typename E>
111  class BaseMultiEdge<-1,E> : public BaseEdge<-1,E>
112  {
113  public:
117  struct HessianHelper {
118  Eigen::Map<MatrixXD> matrix;
119  bool transposed;
120  HessianHelper() : matrix(0, 0, 0), transposed(false) {}
121  };
122 
123  public:
124  static const int Dimension = BaseEdge<-1,E>::Dimension;
125  typedef typename BaseEdge<-1,E>::Measurement Measurement;
126  typedef MatrixXD::MapType JacobianType;
127  typedef typename BaseEdge<-1,E>::ErrorVector ErrorVector;
ErrorVector _error
Definition: base_edge.h:89
std::vector< HessianHelper > _hessian
Measurement _measurement
Definition: base_edge.h:87
virtual bool allVerticesFixed() const
virtual void constructQuadraticForm()
InformationType _information
Definition: base_edge.h:88
void computeQuadraticForm(const InformationType &omega, const ErrorVector &weightedError)
MatrixXD::MapType JacobianType
virtual void computeError()=0
BaseEdge< D, E >::Measurement Measurement
BaseEdge< D, E >::ErrorVector ErrorVector
virtual void mapHessianMemory(double *d, int i, int j, bool rowMajor)
static const int Dimension
virtual void resize(size_t size)
BaseEdge< D, E >::InformationType InformationType
Eigen::Map< MatrixXD, MatrixXD::Flags &Eigen::AlignedBit?Eigen::Aligned:Eigen::Unaligned > HessianBlockType
std::vector< JacobianType, Eigen::aligned_allocator< JacobianType > > _jacobianOplus
jacobians of the edge (w.r.t. oplus)
virtual void linearizeOplus()
VertexContainer _vertices
Definition: hyper_graph.h:202
template<int D, typename E >
void BaseMultiEdge::mapHessianMemory ( double *  d,
int  i,
int  j,
bool  rowMajor 
)
virtual

maps the internal matrix to some external memory location, you need to provide the memory before calling constructQuadraticForm

Parameters
dthe memory location to which we map
iindex of the vertex i
jindex of the vertex j (j > i, upper triangular fashion)
rowMajorif true, will write in rowMajor order to the block. Since EIGEN is columnMajor by default, this results in writing the transposed

Implements g2o::OptimizableGraph::Edge.

Definition at line 130 of file base_multi_edge.h.

Referenced by g2o::BaseMultiEdge< 3, VelocityMeasurement >::BaseMultiEdge().

131  : BaseEdge<-1,E>()
132  {
133  // this->_variableSize = true;
134  }
135 
136  virtual void linearizeOplus(JacobianWorkspace& jacobianWorkspace);
137 
142  virtual void linearizeOplus();
143 
144  virtual void resize(size_t size);
145 
146  virtual bool allVerticesFixed() const;
147 
virtual bool allVerticesFixed() const
virtual void resize(size_t size)
virtual void linearizeOplus()
template<int D, typename E >
void BaseMultiEdge::resize ( size_t  size)
virtual

resizes the number of vertices connected by this edge

Reimplemented from g2o::HyperGraph::Edge.

Definition at line 150 of file base_multi_edge.h.

Referenced by g2o::BaseMultiEdge< 3, VelocityMeasurement >::BaseMultiEdge(), g2o::BaseMultiEdge<-1, E >::BaseMultiEdge(), and main().

154  :
155  using BaseEdge<-1,E>::_measurement;
156  using BaseEdge<-1,E>::_information;
157  using BaseEdge<-1,E>::_error;
158  using BaseEdge<-1,E>::_vertices;
ErrorVector _error
Definition: base_edge.h:89
Measurement _measurement
Definition: base_edge.h:87
InformationType _information
Definition: base_edge.h:88
VertexContainer _vertices
Definition: hyper_graph.h:202

Member Data Documentation

template<int D, typename E>
std::vector<HessianHelper> g2o::BaseMultiEdge< D, E >::_hessian
protected

Definition at line 98 of file base_multi_edge.h.

template<int D, typename E>
std::vector<JacobianType, Eigen::aligned_allocator<JacobianType> > g2o::BaseMultiEdge< D, E >::_jacobianOplus
protected

jacobians of the edge (w.r.t. oplus)

Definition at line 99 of file base_multi_edge.h.

template<int D, typename E>
const int g2o::BaseMultiEdge< D, E >::Dimension = BaseEdge<D,E>::Dimension
static

Definition at line 62 of file base_multi_edge.h.


The documentation for this class was generated from the following files: