//----------------------------------------------------------------------- // ----------------------------------------------------------------------- // file="Vector.Normalize.cs" // Project: StgSharp // AuthorGroup: Nitload Space // Copyright (c) Nitload Space. All rights reserved. // // Permission is hereby granted, free of charge, to any person // obtaining a copy of this software and associated documentation // files (the “Software”), to deal in the Software without restriction, // including without limitation the rights to use, copy, modify, merge, // publish, distribute, sublicense, and/or sell copies of the Software, // and to permit persons to whom the Software is furnished to do so, // subject to the following conditions: // // The above copyright notice and // this permission notice shall be included in all copies // or substantial portions of the Software. // // THE SOFTWARE IS PROVIDED “AS IS”, // WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, // INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, // FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. // IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, // DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, // ARISING FROM, OUT OF OR IN CONNECTION WITH // THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. // // ----------------------------------------------------------------------- // ----------------------------------------------------------------------- using StgSharp.Mathematics.Graphic; using System.Numerics; namespace StgSharp.Mathematics.Graphic { public static partial class Linear { public static Vec4 Normalize(Vec4 vec) { return new Vec4 { vec = Vector4.Normalize(vec.vec) }; } public static Vec3 Normalize(Vec3 vec) { return new Vec3 { v = Vector3.Normalize(vec.v) }; } public static unsafe void Normalize(ref Vec4 source, ref Vec4 target) { Vector4 s = source.vec; Vector4 t = target.vec; s = Vector4.Normalize(s); Vector4 projection = Vector4.Multiply(s, t); t -= projection; source.vec = s; target.vec = t; } public static unsafe void Normalize(ref Vec3 source, ref Vec3 target) { Vector3 s = source.v; Vector3 t = target.v; s = Vector3.Normalize(s); Vector3 projection = Vector3.Dot(t, s) / Vector3.Dot(s, s) * s; t -= projection; t = Vector3.Normalize(t); source.v = s; target.v = t; } } }