ViewVC Help
View File | Revision Log | Show Annotations | View Changeset | Root Listing
root/group/trunk/OOPSE-4/src/math/Vector.hpp
(Generate patch)

Comparing trunk/OOPSE-4/src/math/Vector.hpp (file contents):
Revision 1563 by tim, Wed Oct 13 06:51:09 2004 UTC vs.
Revision 1597 by tim, Tue Oct 19 04:34:35 2004 UTC

# Line 35 | Line 35
35  
36   #include <cassert>
37   #include <cmath>
38 + #include <iostream>
39  
40   namespace oopse {
41  
42 +    const double epsilon = 0.000001;
43 +
44 +    template<typename T>
45 +    inline bool equal(T e1, T e2) {
46 +        return e1 == e2;
47 +    }
48 +
49 +    template<>
50 +    inline bool equal(float e1, float e2) {
51 +        return fabs(e1 - e2) < epsilon;
52 +    }
53 +
54 +    template<>
55 +    inline bool equal(double e1, double e2) {
56 +        return fabs(e1 - e2) < epsilon;
57 +    }
58 +    
59      /**
60       * @class Vector Vector.hpp "math/Vector.hpp"
61       * @brief Fix length vector class
62       */
63 <    template<typename Real, int Dim>
63 >    template<typename Real, unsigned int Dim>
64      class Vector{
65          public:
66  
# Line 67 | Line 85 | namespace oopse {
85                  
86                  return *this;
87              }
88 +
89 +            template<typename T>
90 +            inline Vector(const T& s){
91 +                for (unsigned int i = 0; i < Dim; i++)
92 +                    data_[i] = s;
93 +            }
94              
95              /** Constructs and initializes a Vector from an array */            
96              inline Vector( double* v) {
97 <                for (unsigned int i = 0; i < Dim; i++)
98 <                    data_[i] = v[i];
97 >                for (unsigned int i = 0; i < Dim; i++)
98 >                    data_[i] = v[i];
99              }
100  
101              /**
# Line 114 | Line 138 | namespace oopse {
138                  return data_[i];
139              }
140  
141 +            /**
142 +             * Tests if this vetor is equal to other vector
143 +             * @return true if equal, otherwise return false
144 +             * @param v vector to be compared
145 +             */
146 +             inline bool operator ==(const Vector<Real, Dim>& v) {
147 +
148 +                for (unsigned int i = 0; i < Dim; i ++) {
149 +                    if (!equal(data_[i], v[i])) {
150 +                        return false;
151 +                    }
152 +                }
153 +                
154 +                return true;
155 +            }
156 +
157 +            /**
158 +             * Tests if this vetor is not equal to other vector
159 +             * @return true if equal, otherwise return false
160 +             * @param v vector to be compared
161 +             */
162 +            inline bool operator !=(const Vector<Real, Dim>& v) {
163 +                return !(*this == v);
164 +            }
165 +            
166              /** Negates the value of this vector in place. */          
167              inline void negate() {
168 <                data_[0] = -data_[0];
169 <                data_[1] = -data_[1];
121 <                data_[2] = -data_[2];
168 >                for (unsigned int i = 0; i < Dim; i++)
169 >                    data_[i] = -data_[i];
170              }
171  
172              /**
# Line 136 | Line 184 | namespace oopse {
184              * @param v1 the other vector
185              */
186              inline void add( const Vector<Real, Dim>& v1 ) {
187 <                for (unsigned int i = 0; i < Dim; i++)
188 <                    data_[i] += v1.data_[i];
187 >            for (unsigned int i = 0; i < Dim; i++)
188 >                data_[i] += v1.data_[i];
189                  }
190  
191              /**
# Line 146 | Line 194 | namespace oopse {
194              * @param v2 the second vector
195              */
196              inline void add( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
197 <                for (unsigned int i = 0; i < Dim; i++)
198 <                    data_[i] = v1.data_[i] + v2.data_[i];
197 >                for (unsigned int i = 0; i < Dim; i++)
198 >                    data_[i] = v1.data_[i] + v2.data_[i];
199              }
200  
201              /**
# Line 174 | Line 222 | namespace oopse {
222              * @param s the scalar value
223              */
224              inline void mul( double s ) {
225 <                for (unsigned int i = 0; i < Dim; i++)
225 >                for (unsigned int i = 0; i < Dim; i++)
226                     data_[i] *= s;
227              }
228  
229              /**
230              * Sets the value of this vector to the scalar multiplication of vector v1  
231              * (*this = s * v1).
232 +            * @param v1 the vector            
233              * @param s the scalar value
185 –            * @param v1 the vector
234              */
235 <            inline void mul( double s, const Vector<Real, Dim>& v1 ) {
236 <                for (unsigned int i = 0; i < Dim; i++)
235 >            inline void mul( const Vector<Real, Dim>& v1, double s) {
236 >                for (unsigned int i = 0; i < Dim; i++)
237                      data_[i] = s * v1.data_[i];
238              }
239  
# Line 194 | Line 242 | namespace oopse {
242              * @param s the scalar value
243              */            
244              inline void div( double s) {
245 <                for (unsigned int i = 0; i < Dim; i++)            
245 >                for (unsigned int i = 0; i < Dim; i++)            
246                      data_[i] /= s;
247              }
248  
# Line 204 | Line 252 | namespace oopse {
252              * @param s the scalar value
253              */                        
254              inline void div( const Vector<Real, Dim>& v1, double s ) {
255 <                for (unsigned int i = 0; i < Dim; i++)
255 >                for (unsigned int i = 0; i < Dim; i++)
256                      data_[i] = v1.data_[i] / s;
257              }
258  
259              /** @see #add */
260 <            inline Vector<Real, Dim> operator +=( const Vector<Real, Dim>& v1 ) {
260 >            inline Vector<Real, Dim>& operator +=( const Vector<Real, Dim>& v1 ) {
261                  add(v1);
262                  return *this;
263              }
264  
265              /** @see #sub */
266 <            inline Vector<Real, Dim> operator -=( const Vector<Real, Dim>& v1 ) {
266 >            inline Vector<Real, Dim>& operator -=( const Vector<Real, Dim>& v1 ) {
267                  sub(v1);
268                  return *this;
269              }
270  
271              /** @see #mul */
272 <            inline Vector<Real, Dim> operator *=( double s) {
272 >            inline Vector<Real, Dim>& operator *=( double s) {
273                  mul(s);
274                  return *this;
275              }
276  
277              /** @see #div */
278 <            inline Vector<Real, Dim> operator /=( double s ) {
278 >            inline Vector<Real, Dim>& operator /=( double s ) {
279                  div(s);
280                  return *this;
281              }
# Line 237 | Line 285 | namespace oopse {
285               * @return the length of this vector
286               */
287               inline double length() {
288 <                return sqrt(lengthSquared());  
288 >                return sqrt(lengthSquare());  
289              }
290              
291              /**
292               * Returns the squared length of this vector.
293               * @return the squared length of this vector
294               */
295 <             inline double lengthSquared() {
295 >             inline double lengthSquare() {
296                  return dot(*this, *this);
297              }
298              
# Line 253 | Line 301 | namespace oopse {
301                  double len;
302  
303                  len = length();
304 +                
305 +                //if (len < oopse:epsilon)
306 +                //  throw();
307 +                
308                  *this /= len;
309              }
310 +
311 +            /**
312 +             * Tests if this vector is normalized
313 +             * @return true if this vector is normalized, otherwise return false
314 +             */
315 +            inline bool isNormalized() {
316 +                return equal(lengthSquare(), 1.0);
317 +            }          
318              
319          protected:
320 <            double data_[3];
320 >            double data_[Dim];
321          
322      };
323  
324      /** unary minus*/
325 <    template<typename Real, int Dim>    
325 >    template<typename Real, unsigned int Dim>    
326      inline Vector<Real, Dim> operator -(const Vector<Real, Dim>& v1){
327 <        Vector tmp(v1);
328 <        return tmp.negate();
327 >        Vector<Real, Dim> tmp(v1);
328 >        tmp.negate();
329 >        return tmp;
330      }
331  
332      /**
# Line 274 | Line 335 | namespace oopse {
335       * @param v1 the first vector
336       * @param v2 the second vector
337       */  
338 <    template<typename Real, int Dim>    
338 >    template<typename Real, unsigned int Dim>    
339      inline Vector<Real, Dim> operator +(const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2) {
340          Vector<Real, Dim> result;
341          
# Line 288 | Line 349 | namespace oopse {
349       * @param v1 the first vector
350       * @param v2 the second vector
351       */  
352 <    template<typename Real, int Dim>    
352 >    template<typename Real, unsigned int Dim>    
353      Vector<Real, Dim> operator -(const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2) {
354          Vector<Real, Dim> result;
355          result.sub(v1, v2);
# Line 301 | Line 362 | namespace oopse {
362       * @param v1 the source vector
363       * @param s the scalar value
364       */
365 <    template<typename Real, int Dim>                
365 >    template<typename Real, unsigned int Dim>                
366      Vector<Real, Dim> operator * ( const Vector<Real, Dim>& v1, double s) {      
367          Vector<Real, Dim> result;
368 <        result.mul(s, v1);
368 >        result.mul(v1,s);
369          return result;          
370      }
371      
# Line 314 | Line 375 | namespace oopse {
375       * @param s the scalar value
376       * @param v1 the source vector
377       */  
378 <    template<typename Real, int Dim>
378 >    template<typename Real, unsigned int Dim>
379      Vector<Real, Dim> operator * ( double s, const Vector<Real, Dim>& v1 ) {
380          Vector<Real, Dim> result;
381 <        result.mul(s, v1);
381 >        result.mul(v1, s);
382          return result;          
383      }
384  
# Line 327 | Line 388 | namespace oopse {
388       * @param v1 the source vector
389       * @param s the scalar value
390       */
391 <    template<typename Real, int Dim>    
391 >    template<typename Real, unsigned int Dim>    
392      Vector<Real, Dim> operator / ( const Vector<Real, Dim>& v1, double s) {      
393          Vector<Real, Dim> result;
394          result.div( v1,s);
# Line 335 | Line 396 | namespace oopse {
396      }
397      
398      /**
338 –     * Returns the  value of division of a vector by a scalar.
339 –     * @return  the vaule of scalar division of this vector
340 –     * @param s the scalar value
341 –     * @param v1 the source vector
342 –     */
343 –    template<typename Real, int Dim>        
344 –    inline Vector<Real, Dim> operator /( double s, const Vector<Real, Dim>& v1 ) {
345 –        Vector<Real, Dim> result;
346 –        result.div( v1,s);
347 –        return result;          
348 –    }
349 –
350 –    /** fuzzy comparson */
351 –    template<typename Real, int Dim>        
352 –    inline bool epsilonEqual( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
353 –
354 –    }
355 –
356 –    
357 –    /**
399       * Returns the dot product of two Vectors
400       * @param v1 first vector
401       * @param v2 second vector
402       * @return the dot product of v1 and v2
403       */
404 <    template<typename Real, int Dim>    
404 >    template<typename Real, unsigned int Dim>    
405      inline Real dot( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
406 <                Real tmp;
407 <                tmp = 0;
406 >        Real tmp;
407 >        tmp = 0;
408  
409 <                for (unsigned int i = 0; i < Dim; i++)
410 <                        tmp += v1[i] + v2[i];
411 <                
412 <                return tmp;
409 >        for (unsigned int i = 0; i < Dim; i++)
410 >            tmp += v1[i] + v2[i];
411 >
412 >        return tmp;
413      }
414  
415      /**
# Line 377 | Line 418 | namespace oopse {
418       * @param v2 second vector
419       * @return the distance between v1 and v2
420       */
421 <    template<typename Real, int Dim>    
421 >    template<typename Real, unsigned int Dim>    
422      inline Real distance( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
423          Vector<Real, Dim> tempVector = v1 - v2;
424          return tempVector.length();
# Line 389 | Line 430 | namespace oopse {
430       * @param v2 second vector
431       * @return the squared distance between v1 and v2
432       */
433 <    template<typename Real, int Dim>
433 >    template<typename Real, unsigned int Dim>
434      inline Real distanceSquare( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
435          Vector<Real, Dim> tempVector = v1 - v2;
436          return tempVector.lengthSquare();
# Line 398 | Line 439 | namespace oopse {
439      /**
440       * Write to an output stream
441       */
442 <    template<typename Real, int Dim>
443 <    std::ostream &operator<< ( std::ostream& o, const Vector<Real, Dim>& v1 ) {
444 <        
442 >    template<typename Real, unsigned int Dim>
443 >    std::ostream &operator<< ( std::ostream& o, const Vector<Real, Dim>& v) {
444 >
445 >        o << "[" << v[0] << ", " << v[1] << ", " << v[2] << "]" << endl;
446          return o;        
447      }
448      

Diff Legend

– Removed lines
+ Added lines
< Changed lines
> Changed lines