I don’k know why, but the default Eigen ProductReturnType produces
evaluation error. Maybe, because of destruction of the M matrix before
the evaluation.

The new algorithm computes also data.J to efficiently stored the
previous oSk motion space.

It also computes:
- Jcom directly (works also for robot without FF)
- Energetic terms

Rework Joint Planar + minor modifications