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 1586 by tim, Sun Oct 17 01:19:11 2004 UTC vs.
Revision 2759 by tim, Wed May 17 21:51:42 2006 UTC

# Line 1 | Line 1
1   /*
2 < * Copyright (C) 2000-2004  Object Oriented Parallel Simulation Engine (OOPSE) project
3 < *
4 < * Contact: oopse@oopse.org
5 < *
6 < * This program is free software; you can redistribute it and/or
7 < * modify it under the terms of the GNU Lesser General Public License
8 < * as published by the Free Software Foundation; either version 2.1
9 < * of the License, or (at your option) any later version.
10 < * All we ask is that proper credit is given for our work, which includes
11 < * - but is not limited to - adding the above copyright notice to the beginning
12 < * of your source code files, and to any copyright notice that you may distribute
13 < * with programs based on this work.
14 < *
15 < * This program is distributed in the hope that it will be useful,
16 < * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 < * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18 < * GNU Lesser General Public License for more details.
19 < *
20 < * You should have received a copy of the GNU Lesser General Public License
21 < * along with this program; if not, write to the Free Software
22 < * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
2 > * Copyright (c) 2005 The University of Notre Dame. All Rights Reserved.
3   *
4 + * The University of Notre Dame grants you ("Licensee") a
5 + * non-exclusive, royalty free, license to use, modify and
6 + * redistribute this software in source and binary code form, provided
7 + * that the following conditions are met:
8 + *
9 + * 1. Acknowledgement of the program authors must be made in any
10 + *    publication of scientific results based in part on use of the
11 + *    program.  An acceptable form of acknowledgement is citation of
12 + *    the article in which the program was described (Matthew
13 + *    A. Meineke, Charles F. Vardeman II, Teng Lin, Christopher
14 + *    J. Fennell and J. Daniel Gezelter, "OOPSE: An Object-Oriented
15 + *    Parallel Simulation Engine for Molecular Dynamics,"
16 + *    J. Comput. Chem. 26, pp. 252-271 (2005))
17 + *
18 + * 2. Redistributions of source code must retain the above copyright
19 + *    notice, this list of conditions and the following disclaimer.
20 + *
21 + * 3. Redistributions in binary form must reproduce the above copyright
22 + *    notice, this list of conditions and the following disclaimer in the
23 + *    documentation and/or other materials provided with the
24 + *    distribution.
25 + *
26 + * This software is provided "AS IS," without a warranty of any
27 + * kind. All express or implied conditions, representations and
28 + * warranties, including any implied warranty of merchantability,
29 + * fitness for a particular purpose or non-infringement, are hereby
30 + * excluded.  The University of Notre Dame and its licensors shall not
31 + * be liable for any damages suffered by licensee as a result of
32 + * using, modifying or distributing the software or its
33 + * derivatives. In no event will the University of Notre Dame or its
34 + * licensors be liable for any lost revenue, profit or data, or for
35 + * direct, indirect, special, consequential, incidental or punitive
36 + * damages, however caused and regardless of the theory of liability,
37 + * arising out of the use of or inability to use software, even if the
38 + * University of Notre Dame has been advised of the possibility of
39 + * such damages.
40   */
41 <
41 >
42   /**
43   * @file Vector.hpp
44   * @author Teng Lin
# Line 36 | Line 52
52   #include <cassert>
53   #include <cmath>
54   #include <iostream>
55 <
55 > #include <math.h>
56 > #include "config.h"
57   namespace oopse {
58  
59 <    const double epsilon = 0.000001;
59 >  static const RealType epsilon = 0.000001;
60  
61 <    template<typename T>
62 <    inline bool equal(T e1, T e2) {
63 <        return e1 == e2;
64 <    }
61 >  template<typename T>
62 >  inline bool equal(T e1, T e2) {
63 >    return e1 == e2;
64 >  }
65  
66 <    template<>
67 <    inline bool equal(float e1, float e2) {
68 <        return fabs(e1 - e2) < epsilon;
69 <    }
66 >  //template<>
67 >  //inline bool equal(float e1, float e2) {
68 >  //  return fabs(e1 - e2) < epsilon;
69 >  //}
70  
71 <    template<>
72 <    inline bool equal(double e1, double e2) {
73 <        return fabs(e1 - e2) < epsilon;
74 <    }
71 >  template<>
72 >  inline bool equal(RealType e1, RealType e2) {
73 >    return fabs(e1 - e2) < epsilon;
74 >  }
75 >
76      
77 <    /**
78 <     * @class Vector Vector.hpp "math/Vector.hpp"
79 <     * @brief Fix length vector class
80 <     */
81 <    template<typename Real, unsigned int Dim>
82 <    class Vector{
83 <        public:
77 >  /**
78 >   * @class Vector Vector.hpp "math/Vector.hpp"
79 >   * @brief Fix length vector class
80 >   */
81 >  template<typename Real, unsigned int Dim>
82 >  class Vector{
83 >  public:
84  
85 <            /** default constructor */
86 <            inline Vector(){
69 <                for (unsigned int i = 0; i < Dim; i++)
70 <                    data_[i] = 0.0;
71 <            }
85 >    typedef Real ElemType;
86 >    typedef Real* ElemPoinerType;
87  
88 <            /** Constructs and initializes a Vector from a vector */
89 <            inline Vector(const Vector<Real, Dim>& v) {
90 <                *this  = v;
91 <            }
88 >    /** default constructor */
89 >    inline Vector(){
90 >      for (unsigned int i = 0; i < Dim; i++)
91 >        this->data_[i] = 0;
92 >    }
93  
94 <            /** copy assignment operator */
95 <            inline Vector<Real, Dim>& operator=(const Vector<Real, Dim>& v) {
96 <                if (this == &v)
97 <                    return *this;
94 >    /** Constructs and initializes a Vector from a vector */
95 >    inline Vector(const Vector<Real, Dim>& v) {
96 >      *this  = v;
97 >    }
98 >
99 >    /** copy assignment operator */
100 >    inline Vector<Real, Dim>& operator=(const Vector<Real, Dim>& v) {
101 >      if (this == &v)
102 >        return *this;
103                  
104 <                for (unsigned int i = 0; i < Dim; i++)            
105 <                    data_[i] = v[i];
104 >      for (unsigned int i = 0; i < Dim; i++)            
105 >        this->data_[i] = v[i];
106                  
107 <                return *this;
108 <            }
107 >      return *this;
108 >    }
109 >
110 >    template<typename T>
111 >    inline Vector(const T& s){
112 >      for (unsigned int i = 0; i < Dim; i++)
113 >        this->data_[i] = s;
114 >    }
115              
116 <            /** Constructs and initializes a Vector from an array */            
117 <            inline Vector( double* v) {
118 <                for (unsigned int i = 0; i < Dim; i++)
119 <                    data_[i] = v[i];
120 <            }
116 >    /** Constructs and initializes a Vector from an array */            
117 >    inline Vector( Real* v) {
118 >      for (unsigned int i = 0; i < Dim; i++)
119 >        this->data_[i] = v[i];
120 >    }
121  
122 <            /**
123 <             * Returns reference of ith element.
124 <             * @return reference of ith element
125 <             * @param i index
126 <             */
127 <            inline double& operator[](unsigned int  i) {
128 <                assert( i < Dim);
129 <                return data_[i];
130 <            }
122 >    /**
123 >     * Returns reference of ith element.
124 >     * @return reference of ith element
125 >     * @param i index
126 >     */
127 >    inline Real& operator[](unsigned int  i) {
128 >      assert( i < Dim);
129 >      return this->data_[i];
130 >    }
131  
132 <            /**
133 <             * Returns reference of ith element.
134 <             * @return reference of ith element
135 <             * @param i index
136 <             */
137 <            inline double& operator()(unsigned int  i) {
138 <                assert( i < Dim);
139 <                return data_[i];
140 <            }
132 >    /**
133 >     * Returns reference of ith element.
134 >     * @return reference of ith element
135 >     * @param i index
136 >     */
137 >    inline Real& operator()(unsigned int  i) {
138 >      assert( i < Dim);
139 >      return this->data_[i];
140 >    }
141  
142 <            /**
143 <             * Returns constant reference of ith element.
144 <             * @return reference of ith element
145 <             * @param i index
146 <             */
147 <            inline  const double& operator[](unsigned int i) const {
148 <                assert( i < Dim);
149 <                return data_[i];
150 <            }
142 >    /**
143 >     * Returns constant reference of ith element.
144 >     * @return reference of ith element
145 >     * @param i index
146 >     */
147 >    inline  const Real& operator[](unsigned int i) const {
148 >      assert( i < Dim);
149 >      return this->data_[i];
150 >    }
151  
152 <            /**
153 <             * Returns constant reference of ith element.
154 <             * @return reference of ith element
155 <             * @param i index
156 <             */
157 <            inline  const double& operator()(unsigned int i) const {
158 <                assert( i < Dim);
159 <                return data_[i];
160 <            }
152 >    /**
153 >     * Returns constant reference of ith element.
154 >     * @return reference of ith element
155 >     * @param i index
156 >     */
157 >    inline  const Real& operator()(unsigned int i) const {
158 >      assert( i < Dim);
159 >      return this->data_[i];
160 >    }
161  
162 <            /**
163 <             * Tests if this vetor is equal to other vector
164 <             * @return true if equal, otherwise return false
165 <             * @param v vector to be compared
166 <             */
167 <             inline bool operator ==(const Vector<Real, Dim>& v) {
162 >    /** Copy the internal data to an array*/
163 >    void getArray(Real* array) {
164 >      for (unsigned int i = 0; i < Dim; i ++) {
165 >        array[i] = this->data_[i];
166 >      }                
167 >    }
168  
169 <                for (unsigned int i = 0; i < Dim; i ++) {
170 <                    if (!equal(data_[i], v[i])) {
171 <                        return false;
172 <                    }
173 <                }
169 >    /** Returns the pointer of internal array */
170 >    Real* getArrayPointer() {
171 >      return this->data_;
172 >    }
173 >            
174 >    /**
175 >     * Tests if this vetor is equal to other vector
176 >     * @return true if equal, otherwise return false
177 >     * @param v vector to be compared
178 >     */
179 >    inline bool operator ==(const Vector<Real, Dim>& v) {
180 >
181 >      for (unsigned int i = 0; i < Dim; i ++) {
182 >        if (!equal(this->data_[i], v[i])) {
183 >          return false;
184 >        }
185 >      }
186                  
187 <                return true;
188 <            }
187 >      return true;
188 >    }
189  
190 <            /**
191 <             * Tests if this vetor is not equal to other vector
192 <             * @return true if equal, otherwise return false
193 <             * @param v vector to be compared
194 <             */
195 <            inline bool operator !=(const Vector<Real, Dim>& v) {
196 <                return !(*this == v);
197 <            }
190 >    /**
191 >     * Tests if this vetor is not equal to other vector
192 >     * @return true if equal, otherwise return false
193 >     * @param v vector to be compared
194 >     */
195 >    inline bool operator !=(const Vector<Real, Dim>& v) {
196 >      return !(*this == v);
197 >    }
198              
199 <            /** Negates the value of this vector in place. */          
200 <            inline void negate() {
201 <                data_[0] = -data_[0];
202 <                data_[1] = -data_[1];
203 <                data_[2] = -data_[2];
165 <            }
199 >    /** Negates the value of this vector in place. */          
200 >    inline void negate() {
201 >      for (unsigned int i = 0; i < Dim; i++)
202 >        this->data_[i] = -this->data_[i];
203 >    }
204  
205 <            /**
206 <            * Sets the value of this vector to the negation of vector v1.
207 <            * @param v1 the source vector
208 <            */
209 <            inline void negate(const Vector<Real, Dim>& v1) {
210 <                for (unsigned int i = 0; i < Dim; i++)
211 <                    data_[i] = -v1.data_[i];
205 >    /**
206 >     * Sets the value of this vector to the negation of vector v1.
207 >     * @param v1 the source vector
208 >     */
209 >    inline void negate(const Vector<Real, Dim>& v1) {
210 >      for (unsigned int i = 0; i < Dim; i++)
211 >        this->data_[i] = -v1.data_[i];
212  
213 <            }
213 >    }
214              
215 <            /**
216 <            * Sets the value of this vector to the sum of itself and v1 (*this += v1).
217 <            * @param v1 the other vector
218 <            */
219 <            inline void add( const Vector<Real, Dim>& v1 ) {
220 <            for (unsigned int i = 0; i < Dim; i++)
221 <                data_[i] += v1.data_[i];
184 <                }
185 <
186 <            /**
187 <            * Sets the value of this vector to the sum of v1 and v2 (*this = v1 + v2).
188 <            * @param v1 the first vector
189 <            * @param v2 the second vector
190 <            */
191 <            inline void add( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
192 <                for (unsigned int i = 0; i < Dim; i++)
193 <                    data_[i] = v1.data_[i] + v2.data_[i];
194 <            }
195 <
196 <            /**
197 <            * Sets the value of this vector to the difference  of itself and v1 (*this -= v1).
198 <            * @param v1 the other vector
199 <            */
200 <            inline void sub( const Vector<Real, Dim>& v1 ) {
201 <                for (unsigned int i = 0; i < Dim; i++)
202 <                    data_[i] -= v1.data_[i];
203 <            }
204 <
205 <            /**
206 <            * Sets the value of this vector to the difference of vector v1 and v2 (*this = v1 - v2).
207 <            * @param v1 the first vector
208 <            * @param v2 the second vector
209 <            */
210 <            inline void sub( const Vector<Real, Dim>& v1, const Vector  &v2 ){
211 <                for (unsigned int i = 0; i < Dim; i++)
212 <                    data_[i] = v1.data_[i] - v2.data_[i];
213 <            }
214 <
215 <            /**
216 <            * Sets the value of this vector to the scalar multiplication of itself (*this *= s).
217 <            * @param s the scalar value
218 <            */
219 <            inline void mul( double s ) {
220 <                for (unsigned int i = 0; i < Dim; i++)
221 <                   data_[i] *= s;
222 <            }
223 <
224 <            /**
225 <            * Sets the value of this vector to the scalar multiplication of vector v1  
226 <            * (*this = s * v1).
227 <            * @param s the scalar value
228 <            * @param v1 the vector
229 <            */
230 <            inline void mul( double s, const Vector<Real, Dim>& v1 ) {
231 <                for (unsigned int i = 0; i < Dim; i++)
232 <                    data_[i] = s * v1.data_[i];
233 <            }
234 <
235 <            /**
236 <            * Sets the value of this vector to the scalar division of itself  (*this /= s ).
237 <            * @param s the scalar value
238 <            */            
239 <            inline void div( double s) {
240 <                for (unsigned int i = 0; i < Dim; i++)            
241 <                    data_[i] /= s;
242 <            }
243 <
244 <            /**
245 <            * Sets the value of this vector to the scalar division of vector v1  (*this = v1 / s ).
246 <            * @param v1 the source vector
247 <            * @param s the scalar value
248 <            */                        
249 <            inline void div( const Vector<Real, Dim>& v1, double s ) {
250 <                for (unsigned int i = 0; i < Dim; i++)
251 <                    data_[i] = v1.data_[i] / s;
252 <            }
253 <
254 <            /** @see #add */
255 <            inline Vector<Real, Dim>& operator +=( const Vector<Real, Dim>& v1 ) {
256 <                add(v1);
257 <                return *this;
258 <            }
259 <
260 <            /** @see #sub */
261 <            inline Vector<Real, Dim>& operator -=( const Vector<Real, Dim>& v1 ) {
262 <                sub(v1);
263 <                return *this;
264 <            }
265 <
266 <            /** @see #mul */
267 <            inline Vector<Real, Dim>& operator *=( double s) {
268 <                mul(s);
269 <                return *this;
270 <            }
271 <
272 <            /** @see #div */
273 <            inline Vector<Real, Dim>& operator /=( double s ) {
274 <                div(s);
275 <                return *this;
276 <            }
277 <
278 <            /**
279 <             * Returns the length of this vector.
280 <             * @return the length of this vector
281 <             */
282 <             inline double length() {
283 <                return sqrt(lengthSquared());  
284 <            }
285 <            
286 <            /**
287 <             * Returns the squared length of this vector.
288 <             * @return the squared length of this vector
289 <             */
290 <             inline double lengthSquare() {
291 <                return dot(*this, *this);
292 <            }
293 <            
294 <            /** Normalizes this vector in place */
295 <            inline void normalize() {
296 <                double len;
297 <
298 <                len = length();
299 <                *this /= len;
300 <            }
301 <
302 <            /**
303 <             * Tests if this vector is normalized
304 <             * @return true if this vector is normalized, otherwise return false
305 <             */
306 <            inline bool isNormalized() const
307 <            {
308 <                return lengthSquare() == 1.0;
309 <            }          
310 <            
311 <        protected:
312 <            double data_[3];
313 <        
314 <    };
315 <
316 <    /** unary minus*/
317 <    template<typename Real, unsigned int Dim>    
318 <    inline Vector<Real, Dim> operator -(const Vector<Real, Dim>& v1){
319 <        Vector tmp(v1);
320 <        return tmp.negate();
215 >    /**
216 >     * Sets the value of this vector to the sum of itself and v1 (*this += v1).
217 >     * @param v1 the other vector
218 >     */
219 >    inline void add( const Vector<Real, Dim>& v1 ) {
220 >      for (unsigned int i = 0; i < Dim; i++)
221 >        this->data_[i] += v1.data_[i];
222      }
223  
224      /**
225 <     * Return the sum of two vectors  (v1 - v2).
325 <     * @return the sum of two vectors
225 >     * Sets the value of this vector to the sum of v1 and v2 (*this = v1 + v2).
226       * @param v1 the first vector
227       * @param v2 the second vector
228 <     */  
229 <    template<typename Real, unsigned int Dim>    
230 <    inline Vector<Real, Dim> operator +(const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2) {
231 <        Vector<Real, Dim> result;
332 <        
333 <        result.add(v1, v2);
334 <        return result;        
228 >     */
229 >    inline void add( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
230 >      for (unsigned int i = 0; i < Dim; i++)
231 >        this->data_[i] = v1.data_[i] + v2.data_[i];
232      }
233  
234      /**
235 <     * Return the difference of two vectors  (v1 - v2).
236 <     * @return the difference of two vectors
235 >     * Sets the value of this vector to the difference  of itself and v1 (*this -= v1).
236 >     * @param v1 the other vector
237 >     */
238 >    inline void sub( const Vector<Real, Dim>& v1 ) {
239 >      for (unsigned int i = 0; i < Dim; i++)
240 >        this->data_[i] -= v1.data_[i];
241 >    }
242 >
243 >    /**
244 >     * Sets the value of this vector to the difference of vector v1 and v2 (*this = v1 - v2).
245       * @param v1 the first vector
246       * @param v2 the second vector
247 <     */  
248 <    template<typename Real, unsigned int Dim>    
249 <    Vector<Real, Dim> operator -(const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2) {
250 <        Vector<Real, Dim> result;
346 <        result.sub(v1, v2);
347 <        return result;        
247 >     */
248 >    inline void sub( const Vector<Real, Dim>& v1, const Vector  &v2 ){
249 >      for (unsigned int i = 0; i < Dim; i++)
250 >        this->data_[i] = v1.data_[i] - v2.data_[i];
251      }
252 <    
252 >
253      /**
254 <     * Returns the vaule of scalar multiplication of this vector v1 (v1 * r).
352 <     * @return  the vaule of scalar multiplication of this vector
353 <     * @param v1 the source vector
254 >     * Sets the value of this vector to the scalar multiplication of itself (*this *= s).
255       * @param s the scalar value
256 <     */
257 <    template<typename Real, unsigned int Dim>                
258 <    Vector<Real, Dim> operator * ( const Vector<Real, Dim>& v1, double s) {      
259 <        Vector<Real, Dim> result;
359 <        result.mul(s, v1);
360 <        return result;          
256 >     */
257 >    inline void mul( Real s ) {
258 >      for (unsigned int i = 0; i < Dim; i++)
259 >        this->data_[i] *= s;
260      }
261 <    
261 >
262      /**
263 <     * Returns the vaule of scalar multiplication of this vector v1 (v1 * r).
264 <     * @return  the vaule of scalar multiplication of this vector
263 >     * Sets the value of this vector to the scalar multiplication of vector v1  
264 >     * (*this = s * v1).
265 >     * @param v1 the vector            
266       * @param s the scalar value
267 <     * @param v1 the source vector
268 <     */  
269 <    template<typename Real, unsigned int Dim>
270 <    Vector<Real, Dim> operator * ( double s, const Vector<Real, Dim>& v1 ) {
371 <        Vector<Real, Dim> result;
372 <        result.mul(s, v1);
373 <        return result;          
267 >     */
268 >    inline void mul( const Vector<Real, Dim>& v1, Real s) {
269 >      for (unsigned int i = 0; i < Dim; i++)
270 >        this->data_[i] = s * v1.data_[i];
271      }
272  
273      /**
274 <     * Returns the  value of division of a vector by a scalar.
378 <     * @return  the vaule of scalar division of this vector
379 <     * @param v1 the source vector
274 >     * Sets the value of this vector to the scalar division of itself  (*this /= s ).
275       * @param s the scalar value
276 <     */
277 <    template<typename Real, unsigned int Dim>    
278 <    Vector<Real, Dim> operator / ( const Vector<Real, Dim>& v1, double s) {      
279 <        Vector<Real, Dim> result;
385 <        result.div( v1,s);
386 <        return result;          
276 >     */            
277 >    inline void div( Real s) {
278 >      for (unsigned int i = 0; i < Dim; i++)            
279 >        this->data_[i] /= s;
280      }
281 <    
281 >
282      /**
283 <     * Returns the  value of division of a vector by a scalar.
391 <     * @return  the vaule of scalar division of this vector
392 <     * @param s the scalar value
283 >     * Sets the value of this vector to the scalar division of vector v1  (*this = v1 / s ).
284       * @param v1 the source vector
285 <     */
286 <    template<typename Real, unsigned int Dim>        
287 <    inline Vector<Real, Dim> operator /( double s, const Vector<Real, Dim>& v1 ) {
288 <        Vector<Real, Dim> result;
289 <        result.div( v1,s);
399 <        return result;          
285 >     * @param s the scalar value
286 >     */                        
287 >    inline void div( const Vector<Real, Dim>& v1, Real s ) {
288 >      for (unsigned int i = 0; i < Dim; i++)
289 >        this->data_[i] = v1.data_[i] / s;
290      }
291  
292 <    /** fuzzy comparson */
293 <    template<typename Real, unsigned int Dim>        
294 <    inline bool epsilonEqual( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
292 >    /** @see #add */
293 >    inline Vector<Real, Dim>& operator +=( const Vector<Real, Dim>& v1 ) {
294 >      add(v1);
295 >      return *this;
296 >    }
297  
298 +    /** @see #sub */
299 +    inline Vector<Real, Dim>& operator -=( const Vector<Real, Dim>& v1 ) {
300 +      sub(v1);
301 +      return *this;
302      }
303  
304 <    
305 <    /**
306 <     * Returns the dot product of two Vectors
307 <     * @param v1 first vector
308 <     * @param v2 second vector
413 <     * @return the dot product of v1 and v2
414 <     */
415 <    template<typename Real, unsigned int Dim>    
416 <    inline Real dot( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
417 <        Real tmp;
418 <        tmp = 0;
304 >    /** @see #mul */
305 >    inline Vector<Real, Dim>& operator *=( Real s) {
306 >      mul(s);
307 >      return *this;
308 >    }
309  
310 <        for (unsigned int i = 0; i < Dim; i++)
311 <            tmp += v1[i] + v2[i];
312 <
313 <        return tmp;
310 >    /** @see #div */
311 >    inline Vector<Real, Dim>& operator /=( Real s ) {
312 >      div(s);
313 >      return *this;
314      }
315  
316      /**
317 <     * Returns the distance between  two Vectors
318 <     * @param v1 first vector
319 <     * @param v2 second vector
320 <     * @return the distance between v1 and v2
321 <     */
432 <    template<typename Real, unsigned int Dim>    
433 <    inline Real distance( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
434 <        Vector<Real, Dim> tempVector = v1 - v2;
435 <        return tempVector.length();
317 >     * Returns the length of this vector.
318 >     * @return the length of this vector
319 >     */
320 >    inline Real length() {
321 >      return sqrt(lengthSquare());  
322      }
323 <
323 >            
324      /**
325 <     * Returns the squared distance between  two Vectors
326 <     * @param v1 first vector
441 <     * @param v2 second vector
442 <     * @return the squared distance between v1 and v2
325 >     * Returns the squared length of this vector.
326 >     * @return the squared length of this vector
327       */
328 <    template<typename Real, unsigned int Dim>
329 <    inline Real distanceSquare( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
446 <        Vector<Real, Dim> tempVector = v1 - v2;
447 <        return tempVector.lengthSquare();
328 >    inline Real lengthSquare() {
329 >      return dot(*this, *this);
330      }
331 +            
332 +    /** Normalizes this vector in place */
333 +    inline void normalize() {
334 +      Real len;
335  
336 +      len = length();
337 +                
338 +      //if (len < oopse:epsilon)
339 +      //  throw();
340 +                
341 +      *this /= len;
342 +    }
343 +
344      /**
345 <     * Write to an output stream
345 >     * Tests if this vector is normalized
346 >     * @return true if this vector is normalized, otherwise return false
347       */
348 <    template<typename Real, unsigned int Dim>
349 <    std::ostream &operator<< ( std::ostream& o, const Vector<Real, Dim>& v) {
348 >    inline bool isNormalized() {
349 >      return equal(lengthSquare(), (RealType)1);
350 >    }          
351  
352 <        o << "[" << v[0] << ", " << v[1] << ", " << v[2] << "]" << endl;
353 <        return o;        
352 >    unsigned int size() {return Dim;}
353 >  protected:
354 >    Real data_[Dim];
355 >        
356 >  };
357 >
358 >  /** unary minus*/
359 >  template<typename Real, unsigned int Dim>    
360 >  inline Vector<Real, Dim> operator -(const Vector<Real, Dim>& v1){
361 >    Vector<Real, Dim> tmp(v1);
362 >    tmp.negate();
363 >    return tmp;
364 >  }
365 >
366 >  /**
367 >   * Return the sum of two vectors  (v1 - v2).
368 >   * @return the sum of two vectors
369 >   * @param v1 the first vector
370 >   * @param v2 the second vector
371 >   */  
372 >  template<typename Real, unsigned int Dim>    
373 >  inline Vector<Real, Dim> operator +(const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2) {
374 >    Vector<Real, Dim> result;
375 >        
376 >    result.add(v1, v2);
377 >    return result;        
378 >  }
379 >
380 >  /**
381 >   * Return the difference of two vectors  (v1 - v2).
382 >   * @return the difference of two vectors
383 >   * @param v1 the first vector
384 >   * @param v2 the second vector
385 >   */  
386 >  template<typename Real, unsigned int Dim>    
387 >  Vector<Real, Dim> operator -(const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2) {
388 >    Vector<Real, Dim> result;
389 >    result.sub(v1, v2);
390 >    return result;        
391 >  }
392 >    
393 >  /**
394 >   * Returns the vaule of scalar multiplication of this vector v1 (v1 * r).
395 >   * @return  the vaule of scalar multiplication of this vector
396 >   * @param v1 the source vector
397 >   * @param s the scalar value
398 >   */
399 >  template<typename Real, unsigned int Dim>                
400 >  Vector<Real, Dim> operator * ( const Vector<Real, Dim>& v1, Real s) {      
401 >    Vector<Real, Dim> result;
402 >    result.mul(v1,s);
403 >    return result;          
404 >  }
405 >    
406 >  /**
407 >   * Returns the vaule of scalar multiplication of this vector v1 (v1 * r).
408 >   * @return  the vaule of scalar multiplication of this vector
409 >   * @param s the scalar value
410 >   * @param v1 the source vector
411 >   */  
412 >  template<typename Real, unsigned int Dim>
413 >  Vector<Real, Dim> operator * ( Real s, const Vector<Real, Dim>& v1 ) {
414 >    Vector<Real, Dim> result;
415 >    result.mul(v1, s);
416 >    return result;          
417 >  }
418 >
419 >  /**
420 >   * Returns the  value of division of a vector by a scalar.
421 >   * @return  the vaule of scalar division of this vector
422 >   * @param v1 the source vector
423 >   * @param s the scalar value
424 >   */
425 >  template<typename Real, unsigned int Dim>    
426 >  Vector<Real, Dim> operator / ( const Vector<Real, Dim>& v1, Real s) {      
427 >    Vector<Real, Dim> result;
428 >    result.div( v1,s);
429 >    return result;          
430 >  }
431 >    
432 >  /**
433 >   * Returns the dot product of two Vectors
434 >   * @param v1 first vector
435 >   * @param v2 second vector
436 >   * @return the dot product of v1 and v2
437 >   */
438 >  template<typename Real, unsigned int Dim>    
439 >  inline Real dot( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
440 >    Real tmp;
441 >    tmp = 0;
442 >
443 >    for (unsigned int i = 0; i < Dim; i++)
444 >      tmp += v1[i] * v2[i];
445 >
446 >    return tmp;
447 >  }
448 >
449 >  /**
450 >   * Returns the distance between  two Vectors
451 >   * @param v1 first vector
452 >   * @param v2 second vector
453 >   * @return the distance between v1 and v2
454 >   */  
455 >  template<typename Real, unsigned int Dim>    
456 >  inline Real distance( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
457 >    Vector<Real, Dim> tempVector = v1 - v2;
458 >    return tempVector.length();
459 >  }
460 >
461 >  /**
462 >   * Returns the squared distance between  two Vectors
463 >   * @param v1 first vector
464 >   * @param v2 second vector
465 >   * @return the squared distance between v1 and v2
466 >   */
467 >  template<typename Real, unsigned int Dim>
468 >  inline Real distanceSquare( const Vector<Real, Dim>& v1, const Vector<Real, Dim>& v2 ) {
469 >    Vector<Real, Dim> tempVector = v1 - v2;
470 >    return tempVector.lengthSquare();
471 >  }
472 >
473 >  /**
474 >   * Write to an output stream
475 >   */
476 >  template<typename Real, unsigned int Dim>
477 >  std::ostream &operator<< ( std::ostream& o, const Vector<Real, Dim>& v) {
478 >
479 >    o << "[ ";
480 >        
481 >    for (unsigned int i = 0 ; i< Dim; i++) {
482 >      o << v[i];
483 >
484 >      if (i  != Dim -1) {
485 >        o<< ", ";
486 >      }
487      }
488 +
489 +    o << " ]";
490 +    return o;        
491 +  }
492      
493   }
494   #endif

Diff Legend

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