Improve comments and documentation
Work on locomotion control.
Remove unordered map form wbiy.
Fix computation of Jacobians in icub whole body model interface.