--- trunk/src/math/Vector.hpp	2004/10/13 22:24:59	71
+++ trunk/src/math/Vector.hpp	2004/10/17 01:19:11	93
@@ -39,6 +39,23 @@ namespace oopse {
 
 namespace oopse {
 
+    const double epsilon = 0.000001;
+
+    template<typename T>
+    inline bool equal(T e1, T e2) {
+        return e1 == e2;
+    }
+
+    template<>
+    inline bool equal(float e1, float e2) {
+        return fabs(e1 - e2) < epsilon;
+    }
+
+    template<>
+    inline bool equal(double e1, double e2) {
+        return fabs(e1 - e2) < epsilon;
+    }
+    
     /**
      * @class Vector Vector.hpp "math/Vector.hpp"
      * @brief Fix length vector class
@@ -71,8 +88,8 @@ namespace oopse {
             
             /** Constructs and initializes a Vector from an array */            
             inline Vector( double* v) {
-		for (unsigned int i = 0; i < Dim; i++)
-		    data_[i] = v[i];
+                for (unsigned int i = 0; i < Dim; i++)
+                    data_[i] = v[i];
             }
 
             /** 
@@ -115,6 +132,31 @@ namespace oopse {
                 return data_[i];
             }
 
+            /**
+             * Tests if this vetor is equal to other vector
+             * @return true if equal, otherwise return false
+             * @param v vector to be compared
+             */
+             inline bool operator ==(const Vector<Real, Dim>& v) {
+
+                for (unsigned int i = 0; i < Dim; i ++) {
+                    if (!equal(data_[i], v[i])) {
+                        return false;
+                    }
+                }
+                
+                return true;
+            }
+
+            /**
+             * Tests if this vetor is not equal to other vector
+             * @return true if equal, otherwise return false
+             * @param v vector to be compared
+             */
+            inline bool operator !=(const Vector<Real, Dim>& v) {
+                return !(*this == v);
+            }
+             
             /** Negates the value of this vector in place. */           
             inline void negate() {
                 data_[0] = -data_[0];
@@ -137,8 +179,8 @@ namespace oopse {
             * @param v1 the other vector
             */
             inline void add( const Vector<Real, Dim>& v1 ) {
-            	for (unsigned int i = 0; i < Dim; i++)
-		    data_[i] += v1.data_[i];
+            for (unsigned int i = 0; i < Dim; i++)
+                data_[i] += v1.data_[i];
                 }
 
             /**
@@ -147,8 +189,8 @@ namespace oopse {
             * @param v2 the second vector
             */
             inline void add( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
-            	for (unsigned int i = 0; i < Dim; i++)
-		    data_[i] = v1.data_[i] + v2.data_[i];
+                for (unsigned int i = 0; i < Dim; i++)
+                    data_[i] = v1.data_[i] + v2.data_[i];
             }
 
             /**
@@ -175,7 +217,7 @@ namespace oopse {
             * @param s the scalar value
             */
             inline void mul( double s ) {
-            	for (unsigned int i = 0; i < Dim; i++)
+                for (unsigned int i = 0; i < Dim; i++)
                    data_[i] *= s;
             }
 
@@ -186,7 +228,7 @@ namespace oopse {
             * @param v1 the vector
             */
             inline void mul( double s, const Vector<Real, Dim>& v1 ) {
-            	for (unsigned int i = 0; i < Dim; i++)
+                for (unsigned int i = 0; i < Dim; i++)
                     data_[i] = s * v1.data_[i];
             }
 
@@ -195,7 +237,7 @@ namespace oopse {
             * @param s the scalar value
             */             
             inline void div( double s) {
-            	for (unsigned int i = 0; i < Dim; i++)            
+                for (unsigned int i = 0; i < Dim; i++)            
                     data_[i] /= s;
             }
 
@@ -205,7 +247,7 @@ namespace oopse {
             * @param s the scalar value
             */                         
             inline void div( const Vector<Real, Dim>& v1, double s ) {
-            	for (unsigned int i = 0; i < Dim; i++)
+                for (unsigned int i = 0; i < Dim; i++)
                     data_[i] = v1.data_[i] / s;
             }
 
@@ -245,7 +287,7 @@ namespace oopse {
              * Returns the squared length of this vector.
              * @return the squared length of this vector
              */
-             inline double lengthSquared() {
+             inline double lengthSquare() {
                 return dot(*this, *this);
             }
             
@@ -256,6 +298,15 @@ namespace oopse {
                 len = length();
                 *this /= len;
             }
+
+            /**
+             * Tests if this vector is normalized
+             * @return true if this vector is normalized, otherwise return false
+             */
+            inline bool isNormalized() const
+            {
+                return lengthSquare() == 1.0;
+            }           
             
         protected:
             double data_[3];
@@ -363,13 +414,13 @@ namespace oopse {
      */
     template<typename Real, unsigned int Dim>    
     inline Real dot( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
-		Real tmp;
-		tmp = 0;
+        Real tmp;
+        tmp = 0;
 
-		for (unsigned int i = 0; i < Dim; i++)
-			tmp += v1[i] + v2[i];
-		
-		return tmp;
+        for (unsigned int i = 0; i < Dim; i++)
+            tmp += v1[i] + v2[i];
+
+        return tmp;
     }
 
     /**
@@ -400,8 +451,9 @@ namespace oopse {
      * Write to an output stream
      */
     template<typename Real, unsigned int Dim>
-    std::ostream &operator<< ( std::ostream& o, const Vector<Real, Dim>& v1 ) {
-        
+    std::ostream &operator<< ( std::ostream& o, const Vector<Real, Dim>& v) {
+
+        o << "[" << v[0] << ", " << v[1] << ", " << v[2] << "]" << endl;
         return o;        
     }