Computation of dJ + minor fixes

  * The flags were not taken into account by CMake as they were not
    set correctly.
  * The flags are for aggressive optimization, they should be set in
    robotpkg.conf if needed.

 * Install missing headers.
 * Refactor code.

  MetaPOD is a template-based rigid body dynamics library.