ViewVC Help
View File | Revision Log | Show Annotations | View Changeset | Root Listing
root/OpenMD/branches/development/src/primitives/StuntDouble.hpp
(Generate patch)

Comparing trunk/src/primitives/StuntDouble.hpp (file contents):
Revision 334 by tim, Mon Feb 14 17:57:01 2005 UTC vs.
Revision 1112 by chuckv, Wed Jan 3 20:47:00 2007 UTC

# Line 1 | Line 1
1 < /*
1 > /*
2   * Copyright (c) 2005 The University of Notre Dame. All Rights Reserved.
3   *
4   * The University of Notre Dame grants you ("Licensee") a
# Line 46 | Line 46
46   * @version 1.0
47   */
48    
49 < #ifndef PRIMITIVES_STUNTDOUBLE_HPP
50 < #define PRIMITIVES_STUNTDOUBLE_HPP
49 > #ifndef PRIMITIVES_STUNTDOUBLE_HPP
50 > #define PRIMITIVES_STUNTDOUBLE_HPP
51  
52   #include <vector>
53  
# Line 65 | Line 65 | namespace oopse{
65    /**
66     * @class StuntDouble StuntDouble.hpp "Primitives/StuntDouble.hpp"
67     * @brief
68 +   *     "Don't move, or you're dead! Stand up! Captain, we've got them!"
69 +   *
70 +   *     "Spectacular stunt, my friends, but all for naught. Turn around
71 +   *      please. Ha. What a pity. What a pity. So, Princess, you thought
72 +   *      you could outwit the imperious forces of...."
73 +   *
74 +   *     "You idiots! These are not them. You've captured their stunt
75 +   *      doubles! Search the area. Find them! Find them!"
76 +   *
77     * StuntDouble is a very strange idea.  A StuntDouble stands in for
78     * some object that can be manipulated by the Integrators or
79     * Minimizers.  Some of the manipulable objects are Atoms, some are
80     * DirectionalAtoms, and some are RigidBodies.  StuntDouble
81     * provides an interface for the Integrators and Minimizers to use,
82     * and does some preliminary sanity checking so that the program
83 <   * doesn't try to do something stupid like torque an Atom
83 >   * doesn't try to do something stupid like torque an Atom (The
84 >   * quotes above are from Spaceballs...)
85 >   *
86     * @note the dynamic data of stuntdouble will be stored outside of the class
87     */
88 <   class StuntDouble{
89 <   public:    
88 >  class StuntDouble{
89 >  public:    
90  
91 <        enum ObjectType{
92 <            otAtom,
93 <            otDAtom,
94 <            otRigidBody
95 <        };
91 >    enum ObjectType{
92 >      otAtom,
93 >      otDAtom,
94 >      otRigidBody
95 >    };
96  
97 <        virtual ~StuntDouble();
97 >    virtual ~StuntDouble();
98          
99 <        /**
100 <         * Returns the global index of this stuntdouble.
101 <         * @return  the global index of this stuntdouble
102 <         */
103 <        int getGlobalIndex() {
104 <            return globalIndex_;
105 <        }
99 >    /**
100 >     * Returns the global index of this stuntRealType.
101 >     * @return  the global index of this stuntdouble
102 >     */
103 >    int getGlobalIndex() {
104 >      return globalIndex_;
105 >    }
106  
107 <        /**
108 <         * Sets the global index of this stuntdouble.
109 <         * @param new global index to be set
110 <         */
111 <        void setGlobalIndex(int index) {
112 <             globalIndex_ = index;
113 <        }
107 >    /**
108 >     * Sets the global index of this stuntRealType.
109 >     * @param new global index to be set
110 >     */
111 >    void setGlobalIndex(int index) {
112 >      globalIndex_ = index;
113 >    }
114          
115 <        /**
116 <         * Returns the local index of this stuntdouble
117 <         * @return the local index of this stuntdouble
118 <         */
119 <        int getLocalIndex() {
120 <            return localIndex_;
121 <        }
115 >    /**
116 >     * Returns the local index of this stuntdouble
117 >     * @return the local index of this stuntdouble
118 >     */
119 >    int getLocalIndex() {
120 >      return localIndex_;
121 >    }
122  
123 <        /**
124 <         * Sets the local index of this stuntdouble
125 <         * @param index new index to be set
126 <         */        
127 <        void setLocalIndex(int index) {
128 <            localIndex_ = index;
129 <        }
123 >    /**
124 >     * Sets the local index of this stuntdouble
125 >     * @param index new index to be set
126 >     */        
127 >    void setLocalIndex(int index) {
128 >      localIndex_ = index;
129 >    }
130  
131 <        /**
132 <         * Sets the Snapshot Manager of this stuntdouble
133 <         */
134 <        void setSnapshotManager(SnapshotManager* sman) {
135 <            snapshotMan_ = sman;
136 <        }
131 >  int getGlobalIntegrableObjectIndex(){
132 >        return globalIntegrableObjectIndex_;
133 >  }
134 >  void setGlobalIntegrableObjectIndex(int index) {
135 >     globalIntegrableObjectIndex_ = index;
136 >  }
137  
138 <        /**
139 <         * Tests if this stuntdouble is an atom
140 <         * @return true is this stuntdouble is an atom(or a directional atom), return false otherwise
141 <         */
142 <        bool isAtom(){
143 <            return objType_ == otAtom || objType_ == otDAtom;
133 <        }
138 >    /**
139 >     * Sets the Snapshot Manager of this stuntdouble
140 >     */
141 >    void setSnapshotManager(SnapshotManager* sman) {
142 >      snapshotMan_ = sman;
143 >    }
144  
145 <        /**
146 <         * Tests if this stuntdouble is an directional atom
147 <         * @return true if this stuntdouble is an directional atom, return false otherwise
148 <         */
149 <        bool isDirectionalAtom(){
150 <            return objType_ == otDAtom;
151 <        }
145 >    /**
146 >     * Tests if this stuntdouble is an atom
147 >     * @return true is this stuntdouble is an atom(or a directional atom), return false otherwise
148 >     */
149 >    bool isAtom(){
150 >      return objType_ == otAtom || objType_ == otDAtom;
151 >    }
152  
153 <        /**
154 <         * Tests if this stuntdouble is a rigid body.
155 <         * @return true if this stuntdouble is a rigid body, otherwise return false
156 <         */
157 <        bool isRigidBody(){
158 <            return objType_ == otRigidBody;
159 <        }
153 >    /**
154 >     * Tests if this stuntdouble is an directional atom
155 >     * @return true if this stuntdouble is an directional atom, return false otherwise
156 >     */
157 >    bool isDirectionalAtom(){
158 >      return objType_ == otDAtom;
159 >    }
160  
161 <        /**
162 <         * Tests if this stuntdouble is a directional one.
163 <         * @return true is this stuntdouble is a directional atom or a rigid body, return false otherwise
164 <         */
165 <        bool isDirectional(){
166 <            return isDirectionalAtom() || isRigidBody();
167 <        }
161 >    /**
162 >     * Tests if this stuntdouble is a rigid body.
163 >     * @return true if this stuntdouble is a rigid body, otherwise return false
164 >     */
165 >    bool isRigidBody(){
166 >      return objType_ == otRigidBody;
167 >    }
168  
169 <       /**
170 <         * Returns the previous position of this stuntdouble
171 <         * @return the position of this stuntdouble
172 <         */    
173 <        Vector3d getPrevPos() {
174 <            return ((snapshotMan_->getPrevSnapshot())->*storage_).position[localIndex_];
175 <        }
166 <      
167 <        /**
168 <         * Returns the current position of this stuntdouble
169 <         * @return the position of this stuntdouble
170 <         */    
171 <        Vector3d getPos() {
172 <            return ((snapshotMan_->getCurrentSnapshot())->*storage_).position[localIndex_];
173 <        }
169 >    /**
170 >     * Tests if this stuntdouble is a directional one.
171 >     * @return true is this stuntdouble is a directional atom or a rigid body, return false otherwise
172 >     */
173 >    bool isDirectional(){
174 >      return isDirectionalAtom() || isRigidBody();
175 >    }
176  
177 <       /**
178 <         * Returns the position of this stuntdouble in specified snapshot
179 <         * @return the position of this stuntdouble
180 <         * @param snapshotNo
181 <         */    
182 <        Vector3d getPos(int snapshotNo) {
183 <            return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).position[localIndex_];
184 <        }
177 >    /**
178 >     * Freezes out all velocity, angular velocity, forces and torques
179 >     * on this StuntDouble.  Also computes the number of frozen degrees
180 >     * of freedom.
181 >     * @return the total number of frozen degrees of freedom
182 >     */  
183 >    int freeze() {
184 >      
185 >      int fdf = 3;
186  
187 <       /**
188 <         * Sets  the previous position of this stuntdouble
189 <         * @param pos  new position
190 <         * @see #getPos
191 <         */        
192 <       void setPrevPos(const Vector3d& pos) {
193 <            ((snapshotMan_->getPrevSnapshot())->*storage_).position[localIndex_] = pos;
194 <       }
195 <      
196 <       /**
197 <         * Sets  the current position of this stuntdouble
198 <         * @param pos  new position
199 <         */        
200 <        void setPos(const Vector3d& pos) {
201 <            DataStorage&  data = snapshotMan_->getCurrentSnapshot()->*storage_;
202 <            data.position[localIndex_] = pos;
203 <            //((snapshotMan_->getCurrentSnapshot())->*storage_).position[localIndex_] = pos;
204 <        }
205 <
206 <       /**
204 <         * Sets  the position of this stuntdouble in specified snapshot
205 <         * @param pos position to be set
206 <         * @param snapshotNo
207 <         * @see #getPos
208 <         */        
209 <        void setPos(const Vector3d& pos, int snapshotNo) {
210 <
211 <            ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).position[localIndex_] = pos;
212 <
213 <        }
187 >      setVel(V3Zero);
188 >      setFrc(V3Zero);
189 >      if (isDirectional()){
190 >        setJ(V3Zero);
191 >        setTrq(V3Zero);
192 >        if (isLinear())
193 >          fdf +=2;
194 >        else
195 >          fdf +=3;        
196 >      }      
197 >      return fdf;
198 >    }
199 >
200 >    /**
201 >     * Returns the previous position of this stuntdouble
202 >     * @return the position of this stuntdouble
203 >     */    
204 >    Vector3d getPrevPos() {
205 >      return ((snapshotMan_->getPrevSnapshot())->*storage_).position[localIndex_];
206 >    }
207        
208 <       /**
209 <         * Returns the previous velocity of this stuntdouble
210 <         * @return the velocity of this stuntdouble
211 <         */    
212 <        Vector3d getPrevVel() {
213 <            return ((snapshotMan_->getPrevSnapshot())->*storage_).velocity[localIndex_];
214 <        }
208 >    /**
209 >     * Returns the current position of this stuntdouble
210 >     * @return the position of this stuntdouble
211 >     */    
212 >    Vector3d getPos() {
213 >      return ((snapshotMan_->getCurrentSnapshot())->*storage_).position[localIndex_];
214 >    }
215 >
216 >    /**
217 >     * Returns the position of this stuntdouble in specified snapshot
218 >     * @return the position of this stuntdouble
219 >     * @param snapshotNo
220 >     */    
221 >    Vector3d getPos(int snapshotNo) {
222 >      return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).position[localIndex_];
223 >    }
224 >
225 >    /**
226 >     * Sets  the previous position of this stuntdouble
227 >     * @param pos  new position
228 >     * @see #getPos
229 >     */        
230 >    void setPrevPos(const Vector3d& pos) {
231 >      ((snapshotMan_->getPrevSnapshot())->*storage_).position[localIndex_] = pos;
232 >    }
233        
234 <        /**
235 <         * Returns the current velocity of this stuntdouble
236 <         * @return the velocity of this stuntdouble
237 <         */    
238 <        Vector3d getVel() {
239 <            return ((snapshotMan_->getCurrentSnapshot())->*storage_).velocity[localIndex_];
240 <        }
234 >    /**
235 >     * Sets  the current position of this stuntdouble
236 >     * @param pos  new position
237 >     */        
238 >    void setPos(const Vector3d& pos) {
239 >      DataStorage&  data = snapshotMan_->getCurrentSnapshot()->*storage_;
240 >      data.position[localIndex_] = pos;
241 >      //((snapshotMan_->getCurrentSnapshot())->*storage_).position[localIndex_] = pos;
242 >    }
243  
244 <       /**
245 <         * Returns the velocity of this stuntdouble in specified snapshot
246 <         * @return the velocity of this stuntdouble
247 <         * @param snapshotNo
248 <         */    
249 <         Vector3d getVel(int snapshotNo) {
250 <            return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).velocity[localIndex_];
238 <        }
244 >    /**
245 >     * Sets  the position of this stuntdouble in specified snapshot
246 >     * @param pos position to be set
247 >     * @param snapshotNo
248 >     * @see #getPos
249 >     */        
250 >    void setPos(const Vector3d& pos, int snapshotNo) {
251  
252 <       /**
253 <         * Sets  the previous velocity of this stuntdouble
254 <         * @param vel  new velocity
243 <         * @see #getVel
244 <         */        
245 <       void setPrevVel(const Vector3d& vel) {
246 <            ((snapshotMan_->getPrevSnapshot())->*storage_).velocity[localIndex_] = vel;
247 <       }
252 >      ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).position[localIndex_] = pos;
253 >
254 >    }
255        
256 <       /**
257 <         * Sets  the current velocity of this stuntdouble
258 <         * @param vel  new velocity
259 <         */        
260 <        void setVel(const Vector3d& vel) {
261 <            ((snapshotMan_->getCurrentSnapshot())->*storage_).velocity[localIndex_] = vel;
262 <        }
256 >    /**
257 >     * Returns the previous velocity of this stuntdouble
258 >     * @return the velocity of this stuntdouble
259 >     */    
260 >    Vector3d getPrevVel() {
261 >      return ((snapshotMan_->getPrevSnapshot())->*storage_).velocity[localIndex_];
262 >    }
263 >      
264 >    /**
265 >     * Returns the current velocity of this stuntdouble
266 >     * @return the velocity of this stuntdouble
267 >     */    
268 >    Vector3d getVel() {
269 >      return ((snapshotMan_->getCurrentSnapshot())->*storage_).velocity[localIndex_];
270 >    }
271  
272 <       /**
273 <         * Sets  the velocity of this stuntdouble in specified snapshot
274 <         * @param vel velocity to be set
275 <         * @param snapshotNo
276 <         * @see #getVel
277 <         */        
278 <        void setVel(const Vector3d& vel, int snapshotNo) {
279 <            ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).velocity[localIndex_] = vel;
265 <        }
272 >    /**
273 >     * Returns the velocity of this stuntdouble in specified snapshot
274 >     * @return the velocity of this stuntdouble
275 >     * @param snapshotNo
276 >     */    
277 >    Vector3d getVel(int snapshotNo) {
278 >      return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).velocity[localIndex_];
279 >    }
280  
281 <       /**
282 <         * Returns the previous rotation matrix of this stuntdouble
283 <         * @return the rotation matrix of this stuntdouble
284 <         */    
285 <        RotMat3x3d getPrevA() {
286 <            return ((snapshotMan_->getPrevSnapshot())->*storage_).aMat[localIndex_];
287 <        }
281 >    /**
282 >     * Sets  the previous velocity of this stuntdouble
283 >     * @param vel  new velocity
284 >     * @see #getVel
285 >     */        
286 >    void setPrevVel(const Vector3d& vel) {
287 >      ((snapshotMan_->getPrevSnapshot())->*storage_).velocity[localIndex_] = vel;
288 >    }
289        
290 <        /**
291 <         * Returns the current rotation matrix of this stuntdouble
292 <         * @return the rotation matrix of this stuntdouble
293 <         */    
294 <        RotMat3x3d getA() {
295 <            return ((snapshotMan_->getCurrentSnapshot())->*storage_).aMat[localIndex_];
296 <        }
290 >    /**
291 >     * Sets  the current velocity of this stuntdouble
292 >     * @param vel  new velocity
293 >     */        
294 >    void setVel(const Vector3d& vel) {
295 >      ((snapshotMan_->getCurrentSnapshot())->*storage_).velocity[localIndex_] = vel;
296 >    }
297  
298 <       /**
299 <         * Returns the rotation matrix of this stuntdouble in specified snapshot
300 <         *
301 <         * @return the rotation matrix of this stuntdouble
302 <         * @param snapshotNo
303 <         */    
304 <         RotMat3x3d getA(int snapshotNo) {
305 <            return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).aMat[localIndex_];
306 <        }
298 >    /**
299 >     * Sets  the velocity of this stuntdouble in specified snapshot
300 >     * @param vel velocity to be set
301 >     * @param snapshotNo
302 >     * @see #getVel
303 >     */        
304 >    void setVel(const Vector3d& vel, int snapshotNo) {
305 >      ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).velocity[localIndex_] = vel;
306 >    }
307  
308 <       /**
309 <         * Sets  the previous rotation matrix of this stuntdouble
310 <         * @param a  new rotation matrix
311 <         * @see #getA
312 <         */        
313 <       virtual void setPrevA(const RotMat3x3d& a) {
314 <            ((snapshotMan_->getPrevSnapshot())->*storage_).aMat[localIndex_] = a;
315 <       }
308 >    /**
309 >     * Returns the previous rotation matrix of this stuntdouble
310 >     * @return the rotation matrix of this stuntdouble
311 >     */    
312 >    RotMat3x3d getPrevA() {
313 >      return ((snapshotMan_->getPrevSnapshot())->*storage_).aMat[localIndex_];
314 >    }
315 >      
316 >    /**
317 >     * Returns the current rotation matrix of this stuntdouble
318 >     * @return the rotation matrix of this stuntdouble
319 >     */    
320 >    RotMat3x3d getA() {
321 >      return ((snapshotMan_->getCurrentSnapshot())->*storage_).aMat[localIndex_];
322 >    }
323 >
324 >    /**
325 >     * Returns the rotation matrix of this stuntdouble in specified snapshot
326 >     *
327 >     * @return the rotation matrix of this stuntdouble
328 >     * @param snapshotNo
329 >     */    
330 >    RotMat3x3d getA(int snapshotNo) {
331 >      return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).aMat[localIndex_];
332 >    }
333 >
334 >    /**
335 >     * Sets  the previous rotation matrix of this stuntdouble
336 >     * @param a  new rotation matrix
337 >     * @see #getA
338 >     */        
339 >    virtual void setPrevA(const RotMat3x3d& a) {
340 >      ((snapshotMan_->getPrevSnapshot())->*storage_).aMat[localIndex_] = a;
341 >    }
342        
343 <       /**
344 <         * Sets  the current rotation matrix of this stuntdouble
345 <         * @param a  new rotation matrix
346 <         */        
347 <        virtual void setA(const RotMat3x3d& a) {
348 <            ((snapshotMan_->getCurrentSnapshot())->*storage_).aMat[localIndex_] = a;
349 <        }
343 >    /**
344 >     * Sets  the current rotation matrix of this stuntdouble
345 >     * @param a  new rotation matrix
346 >     */        
347 >    virtual void setA(const RotMat3x3d& a) {
348 >      ((snapshotMan_->getCurrentSnapshot())->*storage_).aMat[localIndex_] = a;
349 >    }
350  
351 <       /**
352 <         * Sets  the rotation matrix of this stuntdouble in specified snapshot
353 <         * @param a rotation matrix to be set
354 <         * @param snapshotNo
355 <         * @see #getA
356 <         */        
357 <        virtual void setA(const RotMat3x3d& a, int snapshotNo) {
358 <            ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).aMat[localIndex_] = a;
359 <        }      
351 >    /**
352 >     * Sets  the rotation matrix of this stuntdouble in specified snapshot
353 >     * @param a rotation matrix to be set
354 >     * @param snapshotNo
355 >     * @see #getA
356 >     */        
357 >    virtual void setA(const RotMat3x3d& a, int snapshotNo) {
358 >      ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).aMat[localIndex_] = a;
359 >    }      
360  
361 <       /**
362 <         * Returns the previous angular momentum of this stuntdouble (body-fixed).
363 <         * @return the angular momentum of this stuntdouble
364 <         */    
365 <        Vector3d getPrevJ() {
366 <            return ((snapshotMan_->getPrevSnapshot())->*storage_).angularMomentum[localIndex_];
367 <        }
361 >    /**
362 >     * Returns the previous angular momentum of this stuntdouble (body-fixed).
363 >     * @return the angular momentum of this stuntdouble
364 >     */    
365 >    Vector3d getPrevJ() {
366 >      return ((snapshotMan_->getPrevSnapshot())->*storage_).angularMomentum[localIndex_];
367 >    }
368        
369 <        /**
370 <         * Returns the current angular momentum of this stuntdouble (body -fixed).
371 <         * @return the angular momentum of this stuntdouble
372 <         */    
373 <        Vector3d getJ() {
374 <            return ((snapshotMan_->getCurrentSnapshot())->*storage_).angularMomentum[localIndex_];
375 <        }
369 >    /**
370 >     * Returns the current angular momentum of this stuntdouble (body -fixed).
371 >     * @return the angular momentum of this stuntdouble
372 >     */    
373 >    Vector3d getJ() {
374 >      return ((snapshotMan_->getCurrentSnapshot())->*storage_).angularMomentum[localIndex_];
375 >    }
376  
377 <       /**
378 <         * Returns the angular momentum of this stuntdouble in specified snapshot (body-fixed).
379 <         * @return the angular momentum of this stuntdouble
380 <         * @param snapshotNo
381 <         */    
382 <         Vector3d getJ(int snapshotNo) {
383 <            return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).angularMomentum[localIndex_];
384 <        }
377 >    /**
378 >     * Returns the angular momentum of this stuntdouble in specified snapshot (body-fixed).
379 >     * @return the angular momentum of this stuntdouble
380 >     * @param snapshotNo
381 >     */    
382 >    Vector3d getJ(int snapshotNo) {
383 >      return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).angularMomentum[localIndex_];
384 >    }
385  
386 <       /**
387 <         * Sets  the previous angular momentum of this stuntdouble (body-fixed).
388 <         * @param angMom  new angular momentum
389 <         * @see #getJ
390 <         */        
391 <       void setPrevJ(const Vector3d& angMom) {
392 <            ((snapshotMan_->getPrevSnapshot())->*storage_).angularMomentum[localIndex_] = angMom;
393 <       }
386 >    /**
387 >     * Sets  the previous angular momentum of this stuntdouble (body-fixed).
388 >     * @param angMom  new angular momentum
389 >     * @see #getJ
390 >     */        
391 >    void setPrevJ(const Vector3d& angMom) {
392 >      ((snapshotMan_->getPrevSnapshot())->*storage_).angularMomentum[localIndex_] = angMom;
393 >    }
394        
395 <       /**
396 <         * Sets  the current angular momentum of this stuntdouble (body-fixed).
397 <         * @param angMom  new angular momentum
398 <         */        
399 <        void setJ(const Vector3d& angMom) {
400 <            ((snapshotMan_->getCurrentSnapshot())->*storage_).angularMomentum[localIndex_] = angMom;
401 <        }
395 >    /**
396 >     * Sets  the current angular momentum of this stuntdouble (body-fixed).
397 >     * @param angMom  new angular momentum
398 >     */        
399 >    void setJ(const Vector3d& angMom) {
400 >      ((snapshotMan_->getCurrentSnapshot())->*storage_).angularMomentum[localIndex_] = angMom;
401 >    }
402  
403 <       /**
404 <         * Sets the angular momentum of this stuntdouble in specified snapshot(body-fixed).
405 <         * @param angMom angular momentum to be set
406 <         * @param snapshotNo
407 <         * @see #getJ
408 <         */        
409 <        void setJ(const Vector3d& angMom, int snapshotNo) {
410 <            ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).angularMomentum[localIndex_] = angMom;
411 <        }
412 <        
413 <       /**
414 <         * Returns the previous quaternion of this stuntdouble
415 <         * @return the quaternion of this stuntdouble
416 <         */    
417 <        Quat4d getPrevQ() {
418 <            return ((snapshotMan_->getPrevSnapshot())->*storage_).aMat[localIndex_].toQuaternion();
419 <        }
403 >    /**
404 >     * Sets the angular momentum of this stuntdouble in specified snapshot(body-fixed).
405 >     * @param angMom angular momentum to be set
406 >     * @param snapshotNo
407 >     * @see #getJ
408 >     */        
409 >    void setJ(const Vector3d& angMom, int snapshotNo) {
410 >      ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).angularMomentum[localIndex_] = angMom;
411 >    }
412 >    
413 >    /**
414 >     * Returns system Center of Mass for stuntdouble frame from snapshot
415 >     *
416 >     */
417 >    Vector3d getCOM(){
418 >      return (snapshotMan_->getCurrentSnapshot())->getCOM();
419 >    }
420 >    
421 >    /**
422 >      * Returns system Center of Mass velocity for stuntdouble frame from snapshot
423 >     *
424 >     */
425 >    
426 >    Vector3d getCOMvel(){
427 >      return (snapshotMan_->getCurrentSnapshot())->getCOMvel();
428 >    }
429 >    
430 >    /**
431 >      * Returns system Center of Mass angular momentum for stuntdouble frame from snapshot
432 >     *
433 >     */
434 >    Vector3d getCOMw(){
435 >      return (snapshotMan_->getCurrentSnapshot())->getCOMw();
436 >    }
437 >    
438 > /**
439 >     * Returns system Center of Mass for stuntdouble frame from snapshot
440 >     *
441 >     */
442 >    Vector3d getCOM(int snapshotNo){
443 >      return (snapshotMan_->getSnapshot(snapshotNo))->getCOM();
444 >    }
445 >    
446 >    /**
447 >      * Returns system Center of Mass velocity for stuntdouble frame from snapshot
448 >     *
449 >     */
450 >    
451 >    Vector3d getCOMvel(int snapshotNo){
452 >      return (snapshotMan_->getSnapshot(snapshotNo))->getCOMvel();
453 >    }
454 >    
455 >    /**
456 >      * Returns system Center of Mass angular momentum for stuntdouble frame from snapshot
457 >     *
458 >     */
459 >    Vector3d getCOMw(int snapshotNo){
460 >      return (snapshotMan_->getSnapshot(snapshotNo))->getCOMw();
461 >    }
462 >
463 >    /**
464 >     * Returns the previous quaternion of this stuntdouble
465 >     * @return the quaternion of this stuntdouble
466 >     */    
467 >    Quat4d getPrevQ() {
468 >      return ((snapshotMan_->getPrevSnapshot())->*storage_).aMat[localIndex_].toQuaternion();
469 >    }
470        
471 <        /**
472 <         * Returns the current quaternion of this stuntdouble
473 <         * @return the quaternion of this stuntdouble
474 <         */    
475 <        Quat4d getQ() {
476 <            return ((snapshotMan_->getCurrentSnapshot())->*storage_).aMat[localIndex_].toQuaternion();
477 <        }
471 >    /**
472 >     * Returns the current quaternion of this stuntdouble
473 >     * @return the quaternion of this stuntdouble
474 >     */    
475 >    Quat4d getQ() {
476 >      return ((snapshotMan_->getCurrentSnapshot())->*storage_).aMat[localIndex_].toQuaternion();
477 >    }
478  
479 <       /**
480 <         * Returns the quaternion of this stuntdouble in specified snapshot
481 <         * @return the quaternion of this stuntdouble
482 <         * @param snapshotNo
483 <         */    
484 <         Quat4d getQ(int snapshotNo) {
485 <            return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).aMat[localIndex_].toQuaternion();
486 <        }
479 >    /**
480 >     * Returns the quaternion of this stuntdouble in specified snapshot
481 >     * @return the quaternion of this stuntdouble
482 >     * @param snapshotNo
483 >     */    
484 >    Quat4d getQ(int snapshotNo) {
485 >      return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).aMat[localIndex_].toQuaternion();
486 >    }
487  
488 <       /**
489 <         * Sets  the previous quaternion of this stuntdouble
490 <         * @param q  new quaternion
491 <         * @note actual storage data is rotation matrix
492 <         */        
493 <       void setPrevQ(const Quat4d& q) {
494 <            setPrevA(q);
495 <       }
488 >    /**
489 >     * Sets  the previous quaternion of this stuntdouble
490 >     * @param q  new quaternion
491 >     * @note actual storage data is rotation matrix
492 >     */        
493 >    void setPrevQ(const Quat4d& q) {
494 >      setPrevA(q);
495 >    }
496        
497 <       /**
498 <         * Sets  the current quaternion of this stuntdouble
499 <         * @param q  new quaternion
500 <         * @note actual storage data is rotation matrix
501 <         */        
502 <        void setQ(const Quat4d& q) {
503 <            setA(q);
504 <        }
497 >    /**
498 >     * Sets  the current quaternion of this stuntdouble
499 >     * @param q  new quaternion
500 >     * @note actual storage data is rotation matrix
501 >     */        
502 >    void setQ(const Quat4d& q) {
503 >      setA(q);
504 >    }
505  
506 <       /**
507 <         * Sets  the quaternion of this stuntdouble in specified snapshot
508 <         *
509 <         * @param q quaternion to be set
510 <         * @param snapshotNo
511 <         * @note actual storage data is rotation matrix
512 <         */        
513 <        void setQ(const Quat4d& q, int snapshotNo) {
514 <            setA(q, snapshotNo);
515 <        }
506 >    /**
507 >     * Sets  the quaternion of this stuntdouble in specified snapshot
508 >     *
509 >     * @param q quaternion to be set
510 >     * @param snapshotNo
511 >     * @note actual storage data is rotation matrix
512 >     */        
513 >    void setQ(const Quat4d& q, int snapshotNo) {
514 >      setA(q, snapshotNo);
515 >    }
516  
517 <       /**
518 <         * Returns the previous euler angles of this stuntdouble
519 <         * @return the euler angles of this stuntdouble
520 <         */    
521 <        Vector3d getPrevEuler() {
522 <            return ((snapshotMan_->getPrevSnapshot())->*storage_).aMat[localIndex_].toEulerAngles();
523 <        }
517 >    /**
518 >     * Returns the previous euler angles of this stuntdouble
519 >     * @return the euler angles of this stuntdouble
520 >     */    
521 >    Vector3d getPrevEuler() {
522 >      return ((snapshotMan_->getPrevSnapshot())->*storage_).aMat[localIndex_].toEulerAngles();
523 >    }
524        
525 <        /**
526 <         * Returns the current euler angles of this stuntdouble
527 <         * @return the euler angles of this stuntdouble
528 <         */    
529 <        Vector3d getEuler() {
530 <            return ((snapshotMan_->getCurrentSnapshot())->*storage_).aMat[localIndex_].toEulerAngles();
531 <        }
525 >    /**
526 >     * Returns the current euler angles of this stuntdouble
527 >     * @return the euler angles of this stuntdouble
528 >     */    
529 >    Vector3d getEuler() {
530 >      return ((snapshotMan_->getCurrentSnapshot())->*storage_).aMat[localIndex_].toEulerAngles();
531 >    }
532  
533 <       /**
534 <         * Returns the euler angles of this stuntdouble in specified snapshot.
535 <         * @return the euler angles of this stuntdouble
536 <         * @param snapshotNo
537 <         */    
538 <         Vector3d getEuler(int snapshotNo) {
539 <            return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).aMat[localIndex_].toEulerAngles();
540 <        }
533 >    /**
534 >     * Returns the euler angles of this stuntdouble in specified snapshot.
535 >     * @return the euler angles of this stuntdouble
536 >     * @param snapshotNo
537 >     */    
538 >    Vector3d getEuler(int snapshotNo) {
539 >      return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).aMat[localIndex_].toEulerAngles();
540 >    }
541  
542 <       /**
543 <         * Sets  the previous euler angles of this stuntdouble.
544 <         * @param euler  new euler angles
545 <         * @see #getEuler
546 <         * @note actual storage data is rotation matrix        
547 <         */        
548 <       void setPrevEuler(const Vector3d& euler) {
549 <            ((snapshotMan_->getPrevSnapshot())->*storage_).aMat[localIndex_] = euler;
550 <       }
542 >    /**
543 >     * Sets  the previous euler angles of this stuntRealType.
544 >     * @param euler  new euler angles
545 >     * @see #getEuler
546 >     * @note actual storage data is rotation matrix        
547 >     */        
548 >    void setPrevEuler(const Vector3d& euler) {
549 >      ((snapshotMan_->getPrevSnapshot())->*storage_).aMat[localIndex_] = euler;
550 >    }
551        
552 <       /**
553 <         * Sets  the current euler angles of this stuntdouble
554 <         * @param euler  new euler angles
555 <         */        
556 <        void setEuler(const Vector3d& euler) {
557 <            ((snapshotMan_->getCurrentSnapshot())->*storage_).aMat[localIndex_] = euler;
558 <        }
552 >    /**
553 >     * Sets  the current euler angles of this stuntdouble
554 >     * @param euler  new euler angles
555 >     */        
556 >    void setEuler(const Vector3d& euler) {
557 >      ((snapshotMan_->getCurrentSnapshot())->*storage_).aMat[localIndex_] = euler;
558 >    }
559  
560 <       /**
561 <         * Sets  the euler angles  of this stuntdouble in specified snapshot
562 <         *
563 <         * @param euler euler angles to be set
564 <         * @param snapshotNo
565 <         * @note actual storage data is rotation matrix                  
566 <         */        
567 <        void setEuler(const Vector3d& euler, int snapshotNo) {
568 <            ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).aMat[localIndex_] = euler;
569 <        }
560 >    /**
561 >     * Sets  the euler angles  of this stuntdouble in specified snapshot
562 >     *
563 >     * @param euler euler angles to be set
564 >     * @param snapshotNo
565 >     * @note actual storage data is rotation matrix                  
566 >     */        
567 >    void setEuler(const Vector3d& euler, int snapshotNo) {
568 >      ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).aMat[localIndex_] = euler;
569 >    }
570        
571 <       /**
572 <         * Returns the previous unit vectors of this stuntdouble
573 <         * @return the unit vectors of this stuntdouble
574 <         */    
575 <        RotMat3x3d getPrevElectroFrame() {
576 <            return ((snapshotMan_->getPrevSnapshot())->*storage_).electroFrame[localIndex_];
577 <        }
571 >    /**
572 >     * Returns the previous unit vectors of this stuntdouble
573 >     * @return the unit vectors of this stuntdouble
574 >     */    
575 >    RotMat3x3d getPrevElectroFrame() {
576 >      return ((snapshotMan_->getPrevSnapshot())->*storage_).electroFrame[localIndex_];
577 >    }
578        
579 <        /**
580 <         * Returns the current unit vectors of this stuntdouble
581 <         * @return the unit vectors of this stuntdouble
582 <         */    
583 <        RotMat3x3d getElectroFrame() {
584 <            return ((snapshotMan_->getCurrentSnapshot())->*storage_).electroFrame[localIndex_];
585 <        }
579 >    /**
580 >     * Returns the current unit vectors of this stuntdouble
581 >     * @return the unit vectors of this stuntdouble
582 >     */    
583 >    RotMat3x3d getElectroFrame() {
584 >      return ((snapshotMan_->getCurrentSnapshot())->*storage_).electroFrame[localIndex_];
585 >    }
586  
587 <       /**
588 <         * Returns the unit vectors of this stuntdouble in specified snapshot
589 <         *
590 <         * @return the unit vectors of this stuntdouble
591 <         * @param snapshotNo
592 <         */    
593 <         RotMat3x3d getElectroFrame(int snapshotNo) {
594 <            return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).electroFrame[localIndex_];
595 <        }
587 >    /**
588 >     * Returns the unit vectors of this stuntdouble in specified snapshot
589 >     *
590 >     * @return the unit vectors of this stuntdouble
591 >     * @param snapshotNo
592 >     */    
593 >    RotMat3x3d getElectroFrame(int snapshotNo) {
594 >      return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).electroFrame[localIndex_];
595 >    }
596  
597 <       /**
598 <         * Returns the previous force of this stuntdouble
599 <         * @return the force of this stuntdouble
600 <         */    
601 <        Vector3d getPrevFrc() {
602 <            return ((snapshotMan_->getPrevSnapshot())->*storage_).force[localIndex_];
603 <        }
597 >    /**
598 >     * Returns the previous force of this stuntdouble
599 >     * @return the force of this stuntdouble
600 >     */    
601 >    Vector3d getPrevFrc() {
602 >      return ((snapshotMan_->getPrevSnapshot())->*storage_).force[localIndex_];
603 >    }
604        
605 <        /**
606 <         * Returns the current force of this stuntdouble
607 <         * @return the force of this stuntdouble
608 <         */    
609 <        Vector3d getFrc() {
610 <            return ((snapshotMan_->getCurrentSnapshot())->*storage_).force[localIndex_];
611 <        }
605 >    /**
606 >     * Returns the current force of this stuntdouble
607 >     * @return the force of this stuntdouble
608 >     */    
609 >    Vector3d getFrc() {
610 >      return ((snapshotMan_->getCurrentSnapshot())->*storage_).force[localIndex_];
611 >    }
612  
613 <       /**
614 <         * Returns the force of this stuntdouble in specified snapshot
615 <         *
616 <         * @return the force of this stuntdouble
617 <         * @param snapshotNo
618 <         */    
619 <         Vector3d getFrc(int snapshotNo) {
620 <            return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).force[localIndex_];
621 <        }
613 >    /**
614 >     * Returns the force of this stuntdouble in specified snapshot
615 >     *
616 >     * @return the force of this stuntdouble
617 >     * @param snapshotNo
618 >     */    
619 >    Vector3d getFrc(int snapshotNo) {
620 >      return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).force[localIndex_];
621 >    }
622  
623 <       /**
624 <         * Sets  the previous force of this stuntdouble
625 <         *
626 <         * @param frc  new force
627 <         * @see #getFrc
628 <         */        
629 <       void setPrevFrc(const Vector3d& frc) {
630 <            ((snapshotMan_->getPrevSnapshot())->*storage_).force[localIndex_] = frc;
631 <       }
623 >    /**
624 >     * Sets  the previous force of this stuntdouble
625 >     *
626 >     * @param frc  new force
627 >     * @see #getFrc
628 >     */        
629 >    void setPrevFrc(const Vector3d& frc) {
630 >      ((snapshotMan_->getPrevSnapshot())->*storage_).force[localIndex_] = frc;
631 >    }
632        
633 <       /**
634 <         * Sets  the current force of this stuntdouble
635 <         * @param frc  new force
636 <         */        
637 <        void setFrc(const Vector3d& frc) {
638 <            ((snapshotMan_->getCurrentSnapshot())->*storage_).force[localIndex_] = frc;
639 <        }
633 >    /**
634 >     * Sets  the current force of this stuntdouble
635 >     * @param frc  new force
636 >     */        
637 >    void setFrc(const Vector3d& frc) {
638 >      ((snapshotMan_->getCurrentSnapshot())->*storage_).force[localIndex_] = frc;
639 >    }
640  
641 <       /**
642 <         * Sets  the force of this stuntdouble in specified snapshot
643 <         *
644 <         * @param frc force to be set
645 <         * @param snapshotNo
646 <         * @see #getFrc
647 <         */        
648 <        void setFrc(const Vector3d& frc, int snapshotNo) {
649 <            ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).force[localIndex_] = frc;
650 <        }
641 >    /**
642 >     * Sets  the force of this stuntdouble in specified snapshot
643 >     *
644 >     * @param frc force to be set
645 >     * @param snapshotNo
646 >     * @see #getFrc
647 >     */        
648 >    void setFrc(const Vector3d& frc, int snapshotNo) {
649 >      ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).force[localIndex_] = frc;
650 >    }
651  
652 <       /**
653 <         * Adds force into the previous force of this stuntdouble
654 <         *
655 <         * @param frc  new force
656 <         * @see #getFrc
657 <         */        
658 <       void addPrevFrc(const Vector3d& frc) {
659 <            ((snapshotMan_->getPrevSnapshot())->*storage_).force[localIndex_] += frc;
660 <       }
652 >    /**
653 >     * Adds force into the previous force of this stuntdouble
654 >     *
655 >     * @param frc  new force
656 >     * @see #getFrc
657 >     */        
658 >    void addPrevFrc(const Vector3d& frc) {
659 >      ((snapshotMan_->getPrevSnapshot())->*storage_).force[localIndex_] += frc;
660 >    }
661        
662 <       /**
663 <         * Adds force into the current force of this stuntdouble
664 <         * @param frc  new force
665 <         */        
666 <        void addFrc(const Vector3d& frc) {
667 <            ((snapshotMan_->getCurrentSnapshot())->*storage_).force[localIndex_] += frc;
668 <        }
662 >    /**
663 >     * Adds force into the current force of this stuntdouble
664 >     * @param frc  new force
665 >     */        
666 >    void addFrc(const Vector3d& frc) {
667 >      ((snapshotMan_->getCurrentSnapshot())->*storage_).force[localIndex_] += frc;
668 >    }
669  
670 <       /**
671 <         * Adds force into the force of this stuntdouble in specified snapshot
672 <         *
673 <         * @param frc force to be set
674 <         * @param snapshotNo
675 <         * @see #getFrc
676 <         */        
677 <        void addFrc(const Vector3d& frc, int snapshotNo) {
678 <            ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).force[localIndex_] += frc;
679 <        }
670 >    /**
671 >     * Adds force into the force of this stuntdouble in specified snapshot
672 >     *
673 >     * @param frc force to be set
674 >     * @param snapshotNo
675 >     * @see #getFrc
676 >     */        
677 >    void addFrc(const Vector3d& frc, int snapshotNo) {
678 >      ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).force[localIndex_] += frc;
679 >    }
680  
681 <       /**
682 <         * Returns the previous torque of this stuntdouble
683 <         * @return the torque of this stuntdouble
684 <         */    
685 <        Vector3d getPrevTrq() {
686 <            return ((snapshotMan_->getPrevSnapshot())->*storage_).torque[localIndex_];
687 <        }
681 >    /**
682 >     * Returns the previous torque of this stuntdouble
683 >     * @return the torque of this stuntdouble
684 >     */    
685 >    Vector3d getPrevTrq() {
686 >      return ((snapshotMan_->getPrevSnapshot())->*storage_).torque[localIndex_];
687 >    }
688        
689 <        /**
690 <         * Returns the current torque of this stuntdouble
691 <         * @return the torque of this stuntdouble
692 <         */    
693 <        Vector3d getTrq() {
694 <            return ((snapshotMan_->getCurrentSnapshot())->*storage_).torque[localIndex_];
695 <        }
689 >    /**
690 >     * Returns the current torque of this stuntdouble
691 >     * @return the torque of this stuntdouble
692 >     */    
693 >    Vector3d getTrq() {
694 >      return ((snapshotMan_->getCurrentSnapshot())->*storage_).torque[localIndex_];
695 >    }
696  
697 <       /**
698 <         * Returns the torque of this stuntdouble in specified snapshot
699 <         *
700 <         * @return the torque of this stuntdouble
701 <         * @param snapshotNo
702 <         */    
703 <         Vector3d getTrq(int snapshotNo) {
704 <            return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).torque[localIndex_];
705 <        }
697 >    /**
698 >     * Returns the torque of this stuntdouble in specified snapshot
699 >     *
700 >     * @return the torque of this stuntdouble
701 >     * @param snapshotNo
702 >     */    
703 >    Vector3d getTrq(int snapshotNo) {
704 >      return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).torque[localIndex_];
705 >    }
706  
707 <       /**
708 <         * Sets  the previous torque of this stuntdouble
709 <         *
710 <         * @param trq  new torque
711 <         * @see #getTrq
712 <         */        
713 <       void setPrevTrq(const Vector3d& trq) {
714 <            ((snapshotMan_->getPrevSnapshot())->*storage_).torque[localIndex_] = trq;
715 <       }
707 >    /**
708 >     * Sets  the previous torque of this stuntdouble
709 >     *
710 >     * @param trq  new torque
711 >     * @see #getTrq
712 >     */        
713 >    void setPrevTrq(const Vector3d& trq) {
714 >      ((snapshotMan_->getPrevSnapshot())->*storage_).torque[localIndex_] = trq;
715 >    }
716        
717 <       /**
718 <         * Sets  the current torque of this stuntdouble
719 <         * @param trq  new torque
720 <         */        
721 <        void setTrq(const Vector3d& trq) {
722 <            ((snapshotMan_->getCurrentSnapshot())->*storage_).torque[localIndex_] = trq;
723 <        }
717 >    /**
718 >     * Sets  the current torque of this stuntdouble
719 >     * @param trq  new torque
720 >     */        
721 >    void setTrq(const Vector3d& trq) {
722 >      ((snapshotMan_->getCurrentSnapshot())->*storage_).torque[localIndex_] = trq;
723 >    }
724  
725 <       /**
726 <         * Sets  the torque of this stuntdouble in specified snapshot
727 <         *
728 <         * @param trq torque to be set
729 <         * @param snapshotNo
730 <         * @see #getTrq
731 <         */        
732 <        void setTrq(const Vector3d& trq, int snapshotNo) {
733 <            ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).torque[localIndex_] = trq;
734 <        }
725 >    /**
726 >     * Sets  the torque of this stuntdouble in specified snapshot
727 >     *
728 >     * @param trq torque to be set
729 >     * @param snapshotNo
730 >     * @see #getTrq
731 >     */        
732 >    void setTrq(const Vector3d& trq, int snapshotNo) {
733 >      ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).torque[localIndex_] = trq;
734 >    }
735  
736 <       /**
737 <         * Adds torque into the previous torque of this stuntdouble
738 <         *
739 <         * @param trq  new torque
740 <         * @see #getTrq
741 <         */        
742 <       void addPrevTrq(const Vector3d& trq) {
743 <            ((snapshotMan_->getPrevSnapshot())->*storage_).torque[localIndex_] += trq;
744 <       }
736 >    /**
737 >     * Adds torque into the previous torque of this stuntdouble
738 >     *
739 >     * @param trq  new torque
740 >     * @see #getTrq
741 >     */        
742 >    void addPrevTrq(const Vector3d& trq) {
743 >      ((snapshotMan_->getPrevSnapshot())->*storage_).torque[localIndex_] += trq;
744 >    }
745        
746 <       /**
747 <         * Adds torque into the current torque of this stuntdouble
748 <         * @param trq  new torque
749 <         */        
750 <        void addTrq(const Vector3d& trq) {
751 <            ((snapshotMan_->getCurrentSnapshot())->*storage_).torque[localIndex_] += trq;
752 <        }
746 >    /**
747 >     * Adds torque into the current torque of this stuntdouble
748 >     * @param trq  new torque
749 >     */        
750 >    void addTrq(const Vector3d& trq) {
751 >      ((snapshotMan_->getCurrentSnapshot())->*storage_).torque[localIndex_] += trq;
752 >    }
753  
754 <       /**
755 <         * Adds torque into the torque of this stuntdouble in specified snapshot
756 <         *
757 <         * @param trq torque to be add
758 <         * @param snapshotNo
759 <         * @see #getTrq
760 <         */        
761 <        void addTrq(const Vector3d& trq, int snapshotNo) {
762 <            ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).torque[localIndex_] += trq;
763 <        }      
754 >    /**
755 >     * Adds torque into the torque of this stuntdouble in specified snapshot
756 >     *
757 >     * @param trq torque to be add
758 >     * @param snapshotNo
759 >     * @see #getTrq
760 >     */        
761 >    void addTrq(const Vector3d& trq, int snapshotNo) {
762 >      ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).torque[localIndex_] += trq;
763 >    }      
764  
765  
766 <       /**
767 <         * Returns the previous z-angle of this stuntdouble
768 <         * @return the z-angle of this stuntdouble
769 <         */    
770 <        double getPrevZangle() {
771 <            return ((snapshotMan_->getPrevSnapshot())->*storage_).zAngle[localIndex_];
772 <        }
766 >    /**
767 >     * Returns the previous z-angle of this stuntdouble
768 >     * @return the z-angle of this stuntdouble
769 >     */    
770 >    RealType getPrevZangle() {
771 >      return ((snapshotMan_->getPrevSnapshot())->*storage_).zAngle[localIndex_];
772 >    }
773        
774 <        /**
775 <         * Returns the current z-angle of this stuntdouble
776 <         * @return the z-angle of this stuntdouble
777 <         */    
778 <        double getZangle() {
779 <            return ((snapshotMan_->getCurrentSnapshot())->*storage_).zAngle[localIndex_];
780 <        }
774 >    /**
775 >     * Returns the current z-angle of this stuntdouble
776 >     * @return the z-angle of this stuntdouble
777 >     */    
778 >    RealType getZangle() {
779 >      return ((snapshotMan_->getCurrentSnapshot())->*storage_).zAngle[localIndex_];
780 >    }
781  
782 <       /**
783 <         * Returns the z-angle of this stuntdouble in specified snapshot
784 <         * @return the z-angle of this stuntdouble
785 <         * @param snapshotNo
786 <         */    
787 <         double getZangle(int snapshotNo) {
788 <            return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).zAngle[localIndex_];
789 <        }
782 >    /**
783 >     * Returns the z-angle of this stuntdouble in specified snapshot
784 >     * @return the z-angle of this stuntdouble
785 >     * @param snapshotNo
786 >     */    
787 >    RealType getZangle(int snapshotNo) {
788 >      return ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).zAngle[localIndex_];
789 >    }
790  
791 <       /**
792 <         * Sets  the previous z-angle of this stuntdouble
793 <         * @param angle  new z-angle
794 <         * @see #getZangle
795 <         */        
796 <       void setPrevZangle(double angle) {
797 <            ((snapshotMan_->getPrevSnapshot())->*storage_).zAngle[localIndex_] = angle;
798 <       }
799 <      
800 <       /**
801 <         * Sets  the current z-angle of this stuntdouble
802 <         * @param angle  new z-angle
803 <         */        
804 <        void setZangle(double angle) {
805 <            ((snapshotMan_->getCurrentSnapshot())->*storage_).zAngle[localIndex_] = angle;
806 <        }
791 >    /**
792 >     * Sets  the previous z-angle of this stuntdouble
793 >     * @param angle  new z-angle
794 >     * @see #getZangle
795 >     */        
796 >    void setPrevZangle(RealType angle) {
797 >      ((snapshotMan_->getPrevSnapshot())->*storage_).zAngle[localIndex_] = angle;
798 >    }
799 >      
800 >    /**
801 >     * Sets  the current z-angle of this stuntdouble
802 >     * @param angle  new z-angle
803 >     */        
804 >    void setZangle(RealType angle) {
805 >      ((snapshotMan_->getCurrentSnapshot())->*storage_).zAngle[localIndex_] = angle;
806 >    }
807  
808 <       /**
809 <         * Sets  the z-angle of this stuntdouble in specified snapshot
810 <         * @param angle z-angle to be set
811 <         * @param snapshotNo
812 <         * @see #getZangle
813 <         */        
814 <        void setZangle(double angle, int snapshotNo) {
815 <            ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).zAngle[localIndex_] = angle;
816 <        }
808 >    /**
809 >     * Sets  the z-angle of this stuntdouble in specified snapshot
810 >     * @param angle z-angle to be set
811 >     * @param snapshotNo
812 >     * @see #getZangle
813 >     */        
814 >    void setZangle(RealType angle, int snapshotNo) {
815 >      ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).zAngle[localIndex_] = angle;
816 >    }
817  
818 <       /**
819 <         * Adds z-angle into the previous z-angle of this stuntdouble
820 <         * @param angle  new z-angle
821 <         * @see #getZangle
822 <         */        
823 <       void addPrevZangle(double angle) {
824 <            ((snapshotMan_->getPrevSnapshot())->*storage_).zAngle[localIndex_] += angle;
825 <       }
818 >    /**
819 >     * Adds z-angle into the previous z-angle of this stuntdouble
820 >     * @param angle  new z-angle
821 >     * @see #getZangle
822 >     */        
823 >    void addPrevZangle(RealType angle) {
824 >      ((snapshotMan_->getPrevSnapshot())->*storage_).zAngle[localIndex_] += angle;
825 >    }
826        
827 <       /**
828 <         * Adds z-angle into the current z-angle of this stuntdouble
829 <         * @param angle  new z-angle
830 <         */        
831 <        void addZangle(double angle) {
832 <            ((snapshotMan_->getCurrentSnapshot())->*storage_).zAngle[localIndex_] += angle;
833 <        }
827 >    /**
828 >     * Adds z-angle into the current z-angle of this stuntdouble
829 >     * @param angle  new z-angle
830 >     */        
831 >    void addZangle(RealType angle) {
832 >      ((snapshotMan_->getCurrentSnapshot())->*storage_).zAngle[localIndex_] += angle;
833 >    }
834  
835 <       /**
836 <         * Adds z-angle into the z-angle of this stuntdouble in specified snapshot
837 <         * @param angle z-angle to be add
838 <         * @param snapshotNo
839 <         * @see #getZangle
840 <         */        
841 <        void addZangle(double angle, int snapshotNo) {
842 <            ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).zAngle[localIndex_] += angle;
843 <        }      
835 >    /**
836 >     * Adds z-angle into the z-angle of this stuntdouble in specified snapshot
837 >     * @param angle z-angle to be add
838 >     * @param snapshotNo
839 >     * @see #getZangle
840 >     */        
841 >    void addZangle(RealType angle, int snapshotNo) {
842 >      ((snapshotMan_->getSnapshot(snapshotNo))->*storage_).zAngle[localIndex_] += angle;
843 >    }      
844  
845 <        /** Set the force of this stuntdouble to zero */
846 <        void zeroForcesAndTorques();
847 <       /**
848 <         * Returns the inertia tensor of this stuntdouble
849 <         * @return the inertia tensor of this stuntdouble
850 <         */
851 <        virtual Mat3x3d getI() = 0;
845 >    /** Set the force of this stuntdouble to zero */
846 >    void zeroForcesAndTorques();
847 >    /**
848 >     * Returns the inertia tensor of this stuntdouble
849 >     * @return the inertia tensor of this stuntdouble
850 >     */
851 >    virtual Mat3x3d getI() = 0;
852  
853 <       /**
854 <         * Returns the gradient of this stuntdouble
855 <         * @return the gradient of this stuntdouble
856 <         */
857 <        virtual std::vector<double> getGrad() = 0;
853 >    /**
854 >     * Returns the gradient of this stuntdouble
855 >     * @return the gradient of this stuntdouble
856 >     */
857 >    virtual std::vector<RealType> getGrad() = 0;
858  
859 <       /**
860 <         * Tests the  if this stuntdouble is a  linear rigidbody
861 <         *
862 <         * @return true if this stuntdouble is a  linear rigidbody, otherwise return false
863 <         * @note atom and directional atom will always return false
864 <         *
865 <         * @see #linearAxis
866 <         */        
867 <        bool isLinear() {
868 <            return linear_;
869 <        }
859 >    /**
860 >     * Tests the  if this stuntdouble is a  linear rigidbody
861 >     *
862 >     * @return true if this stuntdouble is a  linear rigidbody, otherwise return false
863 >     * @note atom and directional atom will always return false
864 >     *
865 >     * @see #linearAxis
866 >     */        
867 >    bool isLinear() {
868 >      return linear_;
869 >    }
870  
871 <       /**
872 <         * Returns the linear axis of the rigidbody, atom and directional atom will always return -1
873 <         *
874 <         * @return the linear axis of the rigidbody
875 <         *
876 <         * @see #isLinear
877 <         */
878 <        int linearAxis() {
879 <            return linearAxis_;
880 <        }
871 >    /**
872 >     * Returns the linear axis of the rigidbody, atom and directional atom will always return -1
873 >     *
874 >     * @return the linear axis of the rigidbody
875 >     *
876 >     * @see #isLinear
877 >     */
878 >    int linearAxis() {
879 >      return linearAxis_;
880 >    }
881  
882 <        /** Returns the mass of this stuntdouble */
883 <        double getMass() {
884 <            return mass_;
885 <        }
882 >    /** Returns the mass of this stuntdouble */
883 >    RealType getMass() {
884 >      return mass_;
885 >    }
886  
887 <        /**
888 <         * Sets the mass of this stuntdoulbe
889 <         * @param mass the mass to be set
890 <         */        
891 <        void setMass(double mass) {
892 <            mass_ = mass;
893 <        }
887 >    /**
888 >     * Sets the mass of this stuntdoulbe
889 >     * @param mass the mass to be set
890 >     */        
891 >    void setMass(RealType mass) {
892 >      mass_ = mass;
893 >    }
894  
895 <        /** Returns the name of this stuntdouble */
896 <        virtual std::string getType() = 0;
895 >    /** Returns the name of this stuntdouble */
896 >    virtual std::string getType() = 0;
897          
898 <        /** Sets the name of this stuntdouble*/
899 <        virtual void setType(const std::string& name) {}
898 >    /** Sets the name of this stuntRealType*/
899 >    virtual void setType(const std::string& name) {}
900  
901 <        /**
902 <         * Converts a lab fixed vector to a body fixed vector.
903 <         * @return body fixed vector
904 <         * @param v lab fixed vector
905 <         */
906 <        Vector3d lab2Body(const Vector3d& v) {
907 <            return getA() * v;
908 <        }
901 >    /**
902 >     * Converts a lab fixed vector to a body fixed vector.
903 >     * @return body fixed vector
904 >     * @param v lab fixed vector
905 >     */
906 >    Vector3d lab2Body(const Vector3d& v) {
907 >      return getA() * v;
908 >    }
909  
910 <        Vector3d lab2Body(const Vector3d& v, int frame) {
911 <            return getA(frame) * v;
912 <        }
910 >    Vector3d lab2Body(const Vector3d& v, int frame) {
911 >      return getA(frame) * v;
912 >    }
913  
914 <        /**
915 <         * Converts a body fixed vector to a lab fixed vector.
916 <         * @return corresponding lab fixed vector
917 <         * @param v body fixed vector
918 <         */
919 <        Vector3d body2Lab(const Vector3d& v){
920 <            return getA().transpose() * v;
921 <        }
914 >    /**
915 >     * Converts a body fixed vector to a lab fixed vector.
916 >     * @return corresponding lab fixed vector
917 >     * @param v body fixed vector
918 >     */
919 >    Vector3d body2Lab(const Vector3d& v){
920 >      return getA().transpose() * v;
921 >    }
922  
923 <        Vector3d body2Lab(const Vector3d& v, int frame){
924 <            return getA(frame).transpose() * v;
925 <        }
926 <        /**
927 <         * <p>
928 <         * The purpose of the Visitor Pattern is to encapsulate an operation that you want to perform on
929 <         * the elements of a data structure. In this way, you can change the operation being performed
930 <         * on a structure without the need of changing the classes of the elements that you are operating
931 <         * on. Using a Visitor pattern allows you to decouple the classes for the data structure and the
932 <         * algorithms used upon them
933 <         * </p>
934 <         * @param v visitor
935 <         */      
936 <        virtual void accept(BaseVisitor* v) = 0;
923 >    Vector3d body2Lab(const Vector3d& v, int frame){
924 >      return getA(frame).transpose() * v;
925 >    }
926 >    /**
927 >     * <p>
928 >     * The purpose of the Visitor Pattern is to encapsulate an operation that you want to perform on
929 >     * the elements of a data structure. In this way, you can change the operation being performed
930 >     * on a structure without the need of changing the classes of the elements that you are operating
931 >     * on. Using a Visitor pattern allows you to decouple the classes for the data structure and the
932 >     * algorithms used upon them
933 >     * </p>
934 >     * @param v visitor
935 >     */      
936 >    virtual void accept(BaseVisitor* v) = 0;
937  
938 <        //below functions are just forward functions
939 <        /**
940 <         * Adds property into property map
941 <         * @param genData GenericData to be added into PropertyMap
942 <         */
943 <        void addProperty(GenericData* genData);
938 >    //below functions are just forward functions
939 >    /**
940 >     * Adds property into property map
941 >     * @param genData GenericData to be added into PropertyMap
942 >     */
943 >    void addProperty(GenericData* genData);
944  
945 <        /**
946 <         * Removes property from PropertyMap by name
947 <         * @param propName the name of property to be removed
948 <         */
949 <        void removeProperty(const std::string& propName);
945 >    /**
946 >     * Removes property from PropertyMap by name
947 >     * @param propName the name of property to be removed
948 >     */
949 >    void removeProperty(const std::string& propName);
950  
951 <        /**
952 <         * clear all of the properties
953 <         */
954 <        void clearProperties();
951 >    /**
952 >     * clear all of the properties
953 >     */
954 >    void clearProperties();
955  
956 <        /**
957 <         * Returns all names of properties
958 <         * @return all names of properties
959 <         */
960 <        std::vector<std::string> getPropertyNames();
956 >    /**
957 >     * Returns all names of properties
958 >     * @return all names of properties
959 >     */
960 >    std::vector<std::string> getPropertyNames();
961  
962 <        /**
963 <         * Returns all of the properties in PropertyMap
964 <         * @return all of the properties in PropertyMap
965 <         */      
966 <        std::vector<GenericData*> getProperties();
962 >    /**
963 >     * Returns all of the properties in PropertyMap
964 >     * @return all of the properties in PropertyMap
965 >     */      
966 >    std::vector<GenericData*> getProperties();
967  
968 <        /**
969 <         * Returns property
970 <         * @param propName name of property
971 <         * @return a pointer point to property with propName. If no property named propName
972 <         * exists, return NULL
973 <         */      
974 <        GenericData* getPropertyByName(const std::string& propName);
968 >    /**
969 >     * Returns property
970 >     * @param propName name of property
971 >     * @return a pointer point to property with propName. If no property named propName
972 >     * exists, return NULL
973 >     */      
974 >    GenericData* getPropertyByName(const std::string& propName);
975  
976 <    protected:
976 >  protected:
977          
978 <        StuntDouble(ObjectType objType, DataStoragePointer storage);
978 >    StuntDouble(ObjectType objType, DataStoragePointer storage);
979          
980 <        StuntDouble(const StuntDouble& sd);
981 <        StuntDouble& operator=(const StuntDouble& sd);
980 >    StuntDouble(const StuntDouble& sd);
981 >    StuntDouble& operator=(const StuntDouble& sd);
982  
983 <        ObjectType objType_;
984 <        DataStoragePointer storage_;
985 <        SnapshotManager* snapshotMan_;
983 >    ObjectType objType_;
984 >    DataStoragePointer storage_;
985 >    SnapshotManager* snapshotMan_;
986          
987 <        bool linear_;
988 <        int linearAxis_;        
987 >    bool linear_;
988 >    int linearAxis_;        
989  
990          
991 <        int globalIndex_;
992 <        int localIndex_;
991 >    int globalIndex_;
992 >    int globalIntegrableObjectIndex_;
993 >    int localIndex_;
994  
995  
996 <        double mass_;
996 >    RealType mass_;
997          
998 <    private:
998 >  private:
999          
1000 <        PropertyMap properties_;
1001 < };
1000 >    PropertyMap properties_;
1001 >  };
1002  
1003   }//end namespace oopse
1004   #endif //PRIMITIVES_STUNTDOUBLE_HPP

Diff Legend

Removed lines
+ Added lines
< Changed lines
> Changed lines