Factor Graph consisting of non-linear factors.
IsDerived< DERIVEDFACTOR > push_back(std::shared_ptr< DERIVEDFACTOR > factor)
Add a factor directly using a shared_ptr.
Rot2 R(Rot2::fromAngle(0.1))
STL compatible allocator to use with types requiring a non standrad alignment.
void addExpressionFactor(const Expression< T > &h, const T &z, const SharedNoiseModel &R)
noiseModel::Base::shared_ptr SharedNoiseModel