BUG fixed: added call to robotJntAngles before calling computeH. The vector qRad was not updated by the black computing invDyn.
Merge branch 'rovereto' of https://github.com/robotology/codyco into rovereto