Modify prototype of method Problem::applyConstraint

  - return true/false for success/failure,
  - return residual error.
Add an interface method in problem to create a position constraint.
Add root joint type and root joint name in python class Robot

  - useful for displaying in rviz.