Corrected issue on QuaternionFromVector3ToVector3()

1 files changed, 7 insertions, 5 deletions

diff --git a/src/raymath.h b/src/raymath.h
index 855f97b0..cd45c0b5 100644
--- a/src/raymath.h
+++ b/src/raymath.h
@@ -1126,13 +1126,15 @@ RMDEF Quaternion QuaternionFromVector3ToVector3(Vector3 from, Vector3 to)
     q.x = cross.x;
     q.y = cross.y;
     q.z = cross.y;
-    q.w = 1.0f + cos2Theta;
-
-    QuaternionNormalize(&q);
+    q.w = 1.0f + cos2Theta;     // NOTE: Added QuaternioIdentity()
+    
+    // Normalize to essentially nlerp the original and identity to 0.5
+    QuaternionNormalize(&q);    
     
-    Quaternion result = QuaternionNlerp(q, QuaternionIdentity(), 0.5f);
+    // Above lines are equivalent to:
+    //Quaternion result = QuaternionNlerp(q, QuaternionIdentity(), 0.5f);
     
-	return result;
+	return q;
 }
 
 // Returns a quaternion for a given rotation matrix