Computational improvement for rotation smoothing

This PR prevent from using atan2(x,y), a high resource consuming function in getAxisAngle.
We should probably do something to prevent using of atan2(x,y)

Signed-off-by: Alkaelis <AlkaelisFenaro@gmail.com>