Some methods must be changed from static to non-static due to JointModelComposite

[Test] Update LieGroup to be indepedant from joint methods {integrate,difference,interpolate,normalize}.

[Constraint] Avoid explicit cast of sparse constraint to dense one. Add matrix methods with correct output