diff --git a/src/localgeodesicfestiffness.hh b/src/localgeodesicfestiffness.hh index e2b16b7d61677f57288b42a186dc598ef04c7df9..9ffddea3c7ddf3a96e0097aa2beec906a4f8f5d6 100644 --- a/src/localgeodesicfestiffness.hh +++ b/src/localgeodesicfestiffness.hh @@ -35,6 +35,16 @@ class LocalGeodesicFEStiffness (i==5)*eps)); } + /** \brief For the fd approximations + */ + static void infinitesimalVariation(RigidBodyMotion<2>& c, double eps, int i) + { + if (i<2) + c.r[i] += eps; + else + c.q = c.q.mult(Rotation<2,double>::exp(Dune::FieldVector<double,1>(eps))); + } + static void infinitesimalVariation(Rotation<3,double>& c, double eps, int i) { c = c.mult(Rotation<3,double>::exp((i==0)*eps,