Use Eigen::Ref for Jacobian matrices.
Modify Roadmap and Node interface

  - For clarity, define two methods instead of using default parameters:
     Roadmap::addNode,
     Roadmap::nearestNode,
     Node::Node.
  - Computation are unchanged.