Fix auto collision check bug.
Remove createBodyForJoint and addBodyToRobot.
Remove dependency to hpp::model.