Bugfix on initialization of jacobian matrix
Merge pull request #61 from SylvainPlessis/kin_eval_bugfix

Bugfix on initialization of jacobian matrix