vectors should be minimally functional...

NetGnome · NetGnome · commit 300ee553636f · 2014-06-21T18:10:59.000-04:00
diff --git a/BehaviorLibrary/Components/Utility/UtilityVector.cs b/BehaviorLibrary/Components/Utility/UtilityVector.cs
@@ -7,6 +7,51 @@ namespace BehaviorLibrary.Components.Utility
 {
     public class UtilityVector
     {
-        public UtilityVector(params float[] values){}
-    }
-}
+        public UtilityVector(params float[] values){
+			this.values = values;
+		}
+
+		public float[] values{ get; set; }
+
+		public float magnitude{ 
+			get{ 
+				float mag = 0;
+				for (int i = 0; i < this.values.Length; i++)
+					mag += this.values [i] * this.values [i];
+
+				return (float) Math.Sqrt (mag);
+			}
+		}
+
+		public UtilityVector normalize(){
+			if (this.values.Length <= 0)
+				return null;
+
+			UtilityVector vec = new UtilityVector();
+			vec.values = new float[this.values.Length];
+			this.values.CopyTo (vec.values, 0);
+
+			float mag = vec.magnitude;
+
+			for (int i = 0; i < vec.values.Length; i++)
+				vec.values [i] = vec.values [i] / mag;
+
+			return vec;
+		}
+
+		public float dot(UtilityVector vector){
+			if (this.magnitude == 0 || vector.magnitude == 0)
+				return -2;
+
+			UtilityVector a = this.normalize ();
+			UtilityVector b = vector.normalize ();
+
+			float val = 0;
+
+			for (int i = 0; i < this.values.Length; i++)
+				val += a.values [i] * b.values [i];
+
+			return val;
+		}
+	}
+}
diff --git a/Tests/UtilityTests.cs b/Tests/UtilityTests.cs
@@ -60,8 +60,29 @@ public void teardown()
             _log.closeLog();
         }
 
+		[Test]
+		public void test_vector(){
+			_log.enterScope ();
+
+			UtilityVector vec1 = new UtilityVector (0, 1, 2, 3, 4, 5);
+
+			float mag = vec1.magnitude;
+			_log.logDebug ("mag: " + mag);
+			VerificationPoint.VerifyTrue ("verify mag gte 0", true, mag >= 0);
+
+			VerificationPoint.VerifyTrue ("norm is not null", true, vec1.normalize () != null);
+
+			UtilityVector vec2 = new UtilityVector (5, 4, 3, 2, 1, 0);
+
+			float dot = vec1.dot (vec2);
+			_log.logDebug ("dot: " + dot);
+			VerificationPoint.VerifyTrue ("dot between 1 and -1", true, (dot <= 1) && (dot >= -1)); 
+
+			_log.exitScope ();
+		}
+
         [Test]
-        public void test_case_1()
+        public void test_1()
         {
             _log.enterScope();
 
