Add Vector3 Projecting and Rejection to Raymath (#3263)

* Update raymath.h

* formatting

1 files changed, 26 insertions, 0 deletions

diff --git a/src/raymath.h b/src/raymath.h
index 86d2c8eb..def8bfd4 100644
--- a/src/raymath.h
+++ b/src/raymath.h
@@ -713,6 +713,32 @@ RMAPI Vector3 Vector3Normalize(Vector3 v)
     return result;
 }
 
+//Calculate the projection of the vector v1 on to v2
+RMAPI Vector3 Vector3Project(Vector3 v1, Vector3 v2)
+{
+    float v1dv2 = (v1.x*v2.x + v1.y*v2.y + v1.z*v2.z);
+    float v2dv2 = (v2.x*v2.x + v2.y*v2.y + v2.z*v2.z);
+
+    float mag = v1dv2/v2dv2;
+
+    Vector3 result = { v2.x*mag , v2.y*mag, v2.z*mag };
+
+    return result;
+}
+
+//Calculate the rejection of the vector v1 on to v2
+RMAPI Vector3 Vector3Reject(Vector3 v1, Vector3 v2)
+{
+    float v1dv2 = (v1.x*v2.x + v1.y*v2.y + v1.z*v2.z);
+    float v2dv2 = (v2.x*v2.x + v2.y*v2.y + v2.z*v2.z);
+
+    float mag = v1dv2/v2dv2;
+
+    Vector3 result = { v1.x - (v2.x*mag) , v1.y - (v2.y*mag), v1.z - (v2.z*mag) };
+
+    return result;
+}
+
 // Orthonormalize provided vectors
 // Makes vectors normalized and orthogonal to each other
 // Gram-Schmidt function implementation