Fix method Problem::lockDof

  - return 0 on success and -1 on failure,
  - catch exceptions.
Add a method to load obstacles from an urdf file.
Cosmetic change: make comment mor explicit.