--- trunk/src/math/Vector.hpp	2004/10/13 06:51:09	70
+++ trunk/src/math/Vector.hpp	2004/10/14 23:28:09	76
@@ -35,14 +35,32 @@
 
 #include <cassert>
 #include <cmath>
+#include <iostream>
 
 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
      */
-    template<typename Real, int Dim>
+    template<typename Real, unsigned int Dim>
     class Vector{
         public:
 
@@ -114,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];
@@ -209,25 +252,25 @@ namespace oopse {
             }
 
             /** @see #add */
-            inline Vector<Real, Dim> operator +=( const Vector<Real, Dim>& v1 ) {
+            inline Vector<Real, Dim>& operator +=( const Vector<Real, Dim>& v1 ) {
                 add(v1);
                 return *this;
             }
 
             /** @see #sub */
-            inline Vector<Real, Dim> operator -=( const Vector<Real, Dim>& v1 ) {
+            inline Vector<Real, Dim>& operator -=( const Vector<Real, Dim>& v1 ) {
                 sub(v1);
                 return *this;
             }
 
             /** @see #mul */
-            inline Vector<Real, Dim> operator *=( double s) {
+            inline Vector<Real, Dim>& operator *=( double s) {
                 mul(s);
                 return *this;
             }
 
             /** @see #div */
-            inline Vector<Real, Dim> operator /=( double s ) {
+            inline Vector<Real, Dim>& operator /=( double s ) {
                 div(s);
                 return *this;
             }
@@ -262,7 +305,7 @@ namespace oopse {
     };
 
     /** unary minus*/
-    template<typename Real, int Dim>    
+    template<typename Real, unsigned int Dim>    
     inline Vector<Real, Dim> operator -(const Vector<Real, Dim>& v1){
         Vector tmp(v1);
         return tmp.negate();
@@ -274,7 +317,7 @@ namespace oopse {
      * @param v1 the first vector
      * @param v2 the second vector
      */   
-    template<typename Real, int Dim>    
+    template<typename Real, unsigned int Dim>    
     inline Vector<Real, Dim> operator +(const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2) {
         Vector<Real, Dim> result;
         
@@ -288,7 +331,7 @@ namespace oopse {
      * @param v1 the first vector
      * @param v2 the second vector
      */  
-    template<typename Real, int Dim>    
+    template<typename Real, unsigned int Dim>    
     Vector<Real, Dim> operator -(const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2) {
         Vector<Real, Dim> result;
         result.sub(v1, v2);
@@ -301,7 +344,7 @@ namespace oopse {
      * @param v1 the source vector
      * @param s the scalar value
      */ 
-    template<typename Real, int Dim>                 
+    template<typename Real, unsigned int Dim>                 
     Vector<Real, Dim> operator * ( const Vector<Real, Dim>& v1, double s) {       
         Vector<Real, Dim> result;
         result.mul(s, v1);
@@ -314,7 +357,7 @@ namespace oopse {
      * @param s the scalar value
      * @param v1 the source vector
      */  
-    template<typename Real, int Dim>
+    template<typename Real, unsigned int Dim>
     Vector<Real, Dim> operator * ( double s, const Vector<Real, Dim>& v1 ) {
         Vector<Real, Dim> result;
         result.mul(s, v1);
@@ -327,7 +370,7 @@ namespace oopse {
      * @param v1 the source vector
      * @param s the scalar value
      */
-    template<typename Real, int Dim>    
+    template<typename Real, unsigned int Dim>    
     Vector<Real, Dim> operator / ( const Vector<Real, Dim>& v1, double s) {       
         Vector<Real, Dim> result;
         result.div( v1,s);
@@ -340,7 +383,7 @@ namespace oopse {
      * @param s the scalar value
      * @param v1 the source vector
      */
-    template<typename Real, int Dim>        
+    template<typename Real, unsigned int Dim>        
     inline Vector<Real, Dim> operator /( double s, const Vector<Real, Dim>& v1 ) {
         Vector<Real, Dim> result;
         result.div( v1,s);
@@ -348,7 +391,7 @@ namespace oopse {
     }
 
     /** fuzzy comparson */
-    template<typename Real, int Dim>        
+    template<typename Real, unsigned int Dim>        
     inline bool epsilonEqual( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
 
     }
@@ -360,7 +403,7 @@ namespace oopse {
      * @param v2 second vector
      * @return the dot product of v1 and v2
      */
-    template<typename Real, int Dim>    
+    template<typename Real, unsigned int Dim>    
     inline Real dot( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
 		Real tmp;
 		tmp = 0;
@@ -377,7 +420,7 @@ namespace oopse {
      * @param v2 second vector
      * @return the distance between v1 and v2
      */	
-    template<typename Real, int Dim>    
+    template<typename Real, unsigned int Dim>    
     inline Real distance( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
         Vector<Real, Dim> tempVector = v1 - v2;
         return tempVector.length();
@@ -389,7 +432,7 @@ namespace oopse {
      * @param v2 second vector
      * @return the squared distance between v1 and v2
      */
-    template<typename Real, int Dim>
+    template<typename Real, unsigned int Dim>
     inline Real distanceSquare( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
         Vector<Real, Dim> tempVector = v1 - v2;
         return tempVector.lengthSquare();
@@ -398,7 +441,7 @@ namespace oopse {
     /**
      * Write to an output stream
      */
-    template<typename Real, int Dim>
+    template<typename Real, unsigned int Dim>
     std::ostream &operator<< ( std::ostream& o, const Vector<Real, Dim>& v1 ) {
         
         return o;