Removed RotationVectorDiff
Fixed unit tests