Fix Array AddRef, added Normalize data algorithm

Author: muit

Include/PipeAlgorithms.h

@@ -535,6 +535,26 @@ namespace p
 	}
 #pragma endregion Sort
 
+#pragma region Transformations
+	template<typename T, typename Index>
+	void Normalize(T* first, Index size)
+	{
+		T magnitude = {};
+		for (Index i = 0; i < size; ++i)
+		{
+			const T& value = first[i];
+			magnitude += value * value;
+		}
+		if (magnitude > T(0))
+		{
+			const T invMagnitude = InvSqrt(magnitude);
+			for (Index i = 0; i < size; ++i)
+			{
+				first[i] *= invMagnitude;
+			}
+		}
+	}
+#pragma endregion Transformations
 
 	/** Generates CRC hash of the memory area */
 	PIPE_API u32 MemCrc32(const void* Data, i32 Length, u32 CRC = 0);

Include/PipeArrays.h

@@ -841,17 +841,20 @@ namespace p
 			new (Super::data + firstIdx) Type(value);
 			return firstIdx;
 		}
-		Type& AddRef()
+		inline Type& AddRef()
 		{
-			return Super::data[Add()];
+			const i32 idx = Add();
+			return Super::data[idx];
 		}
-		Type& AddRef(Type&& value)
+		inline Type& AddRef(Type&& value)
 		{
-			return Super::data[Add(p::Forward<Type>(value))];
+			const i32 idx = Add(p::Forward<Type>(value));
+			return Super::data[idx];
 		}
-		Type& AddRef(const Type& value)
+		inline Type& AddRef(const Type& value)
 		{
-			return Super::data[Add(value)];
+			const i32 idx = Add(value);
+			return Super::data[idx];
 		}
 
 		template<typename SortPredicate = TLess<Type>>

Include/PipeMath.h

@@ -259,6 +259,18 @@ namespace p
 	{
 		return 1.f / Sqrt(x);
 	}
+	inline PIPE_API double InvSqrt(double x)
+	{
+		return 1. / Sqrt(x);
+	}
+	inline PIPE_API float InvSqrt(i32 x)
+	{
+		return 1.f / Sqrt(x);
+	}
+	inline PIPE_API double InvSqrt(i64 x)
+	{
+		return 1. / Sqrt(x);
+	}
 
 	template<typename T>
 	static constexpr T Square(T val)

Include/PipeVectors.h

@@ -85,7 +85,7 @@ namespace p
 			const T lengthSquared = LengthSquared();
 			if (lengthSquared > 0.f)
 			{
-				const float scale = InvSqrt(lengthSquared);
+				const auto scale = InvSqrt(lengthSquared);
 				x *= scale;
 				y *= scale;
 			}
@@ -365,7 +365,7 @@ namespace p
 			const T lengthSqrt = LengthSquared();
 			if (lengthSqrt > 0.f)
 			{
-				const float scale = InvSqrt(lengthSqrt);
+				const auto scale = InvSqrt(lengthSqrt);
 				x *= scale;
 				y *= scale;
 				z *= scale;