Updated way to compute quaternion
Updated way to compute quaternion

If you want to check, as I implemented it... @DanielePucci @traversaro

robotology/idyntree,robotology/idyntree,robotology/idyntree,robotology/idyntree,robotology/idyntree