Skip to content

Commit

Permalink
Add Vector3 Projecting and Rejection to Raymath (#3263)
Browse files Browse the repository at this point in the history
* Update raymath.h

* formatting
  • Loading branch information
Dial0 committed Aug 26, 2023
1 parent 21f5482 commit 828d273
Showing 1 changed file with 26 additions and 0 deletions.
26 changes: 26 additions & 0 deletions src/raymath.h
Original file line number Diff line number Diff line change
Expand Up @@ -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
Expand Down

0 comments on commit 828d273

Please sign in to comment.