Add Transform.LocalToWorldVector and Transform.WorldToLocalVector

This commit is contained in:
Wojtek Figat
2021-01-26 12:11:41 +01:00
parent 023cdced0a
commit dda5f26d89
3 changed files with 74 additions and 0 deletions

View File

@@ -94,6 +94,13 @@ Vector3 Transform::LocalToWorld(const Vector3& point) const
return result + Translation;
}
Vector3 Transform::LocalToWorldVector(const Vector3& vector) const
{
Vector3 result = vector * Scale;
Vector3::Transform(result, Orientation, result);
return result;
}
void Transform::LocalToWorld(const Vector3& point, Vector3& result) const
{
Vector3 tmp = point * Scale;
@@ -171,6 +178,24 @@ Vector3 Transform::WorldToLocal(const Vector3& point) const
return result * invScale;
}
Vector3 Transform::WorldToLocalVector(const Vector3& vector) const
{
Vector3 invScale = Scale;
if (invScale.X != 0.0f)
invScale.X = 1.0f / invScale.X;
if (invScale.Y != 0.0f)
invScale.Y = 1.0f / invScale.Y;
if (invScale.Z != 0.0f)
invScale.Z = 1.0f / invScale.Z;
const Quaternion invRotation = Orientation.Conjugated();
Vector3 result;
Vector3::Transform(vector, invRotation, result);
return result * invScale;
}
void Transform::WorldToLocal(const Vector3* points, int32 pointsCount, Vector3* result) const
{
Vector3 invScale = Scale;