Initialized to zero all the matrices to avoid uninitialized objects (iDynTree does not clear the vectors/matrices correctly)
Merge branch 'master' of https://github.com/robotology/codyco