1 |
< |
#ifndef __RIGIDBODY_HPP__ |
2 |
< |
#define __RIGIDBODY_HPP__ |
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. |
23 |
> |
* |
24 |
> |
*/ |
25 |
|
|
26 |
< |
#include <vector> |
27 |
< |
//#include "primitives/Atom.hpp" |
28 |
< |
//#include "types/AtomStamp.hpp" |
29 |
< |
#include "types/RigidBodyStamp.hpp" |
30 |
< |
#include "primitives/StuntDouble.hpp" |
31 |
< |
using namespace std; |
26 |
> |
/** |
27 |
> |
* @file RigidBody.hpp |
28 |
> |
* @author tlin |
29 |
> |
* @date 10/23/2004 |
30 |
> |
* @version 1.0 |
31 |
> |
*/ |
32 |
|
|
33 |
< |
class Atom; |
34 |
< |
class AtomStamp; |
33 |
> |
#ifndef PRIMITIVES_RIGIDBODY_HPP |
34 |
> |
#define PRIMITIVES_RIGIDBODY_HPP |
35 |
|
|
36 |
< |
typedef struct { |
15 |
< |
double vec[3]; |
16 |
< |
double& operator[](int index) {return vec[index];} |
17 |
< |
} vec3; |
36 |
> |
#include <vector> |
37 |
|
|
38 |
< |
typedef struct { |
39 |
< |
double mat[3][3]; |
40 |
< |
double* operator[](int index) {return mat[index];} |
41 |
< |
} mat3x3; |
38 |
> |
#include "primitives/StuntDouble.hpp" |
39 |
> |
#include "primitives/DirectionalAtom.hpp" |
40 |
> |
#include "types/AtomStamp.hpp" |
41 |
> |
namespace oopse{ |
42 |
> |
class RigidBody : public StuntDouble { |
43 |
> |
public: |
44 |
> |
RigidBody(); |
45 |
|
|
46 |
< |
class RigidBody : public StuntDouble { |
46 |
> |
/** |
47 |
> |
* Sets the previous rotation matrix of this stuntdouble |
48 |
> |
* @param a new rotation matrix |
49 |
> |
*/ |
50 |
> |
virtual void setPrevA(const RotMat3x3d& a); |
51 |
> |
|
52 |
> |
/** |
53 |
> |
* Sets the current rotation matrix of this stuntdouble |
54 |
> |
* @param a new rotation matrix |
55 |
> |
*/ |
56 |
> |
virtual void setA(const RotMat3x3d& a); |
57 |
> |
/** |
58 |
> |
* Sets the rotation matrix of this stuntdouble in specified snapshot |
59 |
> |
* @param a rotation matrix to be set |
60 |
> |
* @param snapshotNo |
61 |
> |
* @see #getA |
62 |
> |
*/ |
63 |
> |
virtual void setA(const RotMat3x3d& a, int snapshotNo); |
64 |
|
|
65 |
< |
public: |
66 |
< |
|
67 |
< |
RigidBody(); |
68 |
< |
//RigidBody(const RigidBody& rb); |
69 |
< |
|
31 |
< |
virtual ~RigidBody(); |
32 |
< |
|
33 |
< |
void addAtom(Atom* at, AtomStamp* ats); |
65 |
> |
/** |
66 |
> |
* Returns the inertia tensor of this stuntdouble |
67 |
> |
* @return the inertia tensor of this stuntdouble |
68 |
> |
*/ |
69 |
> |
virtual Mat3x3d getI(); |
70 |
|
|
35 |
– |
void getPos( double theP[3] ); |
36 |
– |
void setPos( double theP[3] ); |
71 |
|
|
72 |
< |
void getVel( double theV[3] ); |
73 |
< |
void setVel( double theV[3] ); |
72 |
> |
/** Sets the internal unit frame of this stuntdouble by three euler angles */ |
73 |
> |
void setUnitFrameFromEuler(double phi, double theta, double psi); |
74 |
> |
|
75 |
> |
/** |
76 |
> |
* Returns the gradient of this stuntdouble |
77 |
> |
* @return the inertia tensor of this stuntdouble |
78 |
> |
* @see #setI |
79 |
> |
*/ |
80 |
> |
virtual std::vector<double> getGrad(); |
81 |
|
|
82 |
< |
void getFrc( double theF[3] ); |
42 |
< |
void addFrc( double theF[3] ); |
43 |
< |
void zeroForces(); |
44 |
< |
|
45 |
< |
virtual bool isLinear() {return is_linear;} |
46 |
< |
virtual int linearAxis() {return linear_axis;} |
82 |
> |
virtual void accept(BaseVisitor* v); |
83 |
|
|
84 |
< |
double getMass( void ) { return mass; } |
84 |
> |
void addAtom(Atom* at, AtomStamp* ats); |
85 |
|
|
86 |
< |
void printAmatIndex( void ); |
87 |
< |
void setEuler( double phi, double theta, double psi ); |
52 |
< |
void getQ( double the_q[4] ); // get the quanternions |
53 |
< |
void setQ( double the_q[4] ); |
86 |
> |
/** calculate the reference coordinates */ |
87 |
> |
void calcRefCoords(); |
88 |
|
|
89 |
< |
void getA( double the_A[3][3] ); // get the full rotation matrix |
90 |
< |
void setA( double the_A[3][3] ); |
89 |
> |
/** Convert Atomic forces and torques to total forces and torques */ |
90 |
> |
void calcForcesAndTorques(); |
91 |
|
|
92 |
< |
void getJ( double theJ[3] ); |
93 |
< |
void setJ( double theJ[3] ); |
92 |
> |
/** update the positions of atoms belong to this rigidbody */ |
93 |
> |
void updateAtoms(); |
94 |
|
|
95 |
< |
virtual void setType(char* type) {strcpy(rbName, type);} |
62 |
< |
virtual char* getType() { return rbName;} |
95 |
> |
Atom* beginAtom(std::vector<Atom*>::iterator& i); |
96 |
|
|
97 |
< |
void getTrq( double theT[3] ); |
65 |
< |
void addTrq( double theT[3] ); |
97 |
> |
Atom* nextAtom(std::vector<Atom*>::iterator& i); |
98 |
|
|
99 |
< |
void getI( double the_I[3][3] ); |
100 |
< |
void lab2Body( double r[3] ); |
101 |
< |
void body2Lab( double r[3] ); |
99 |
> |
std::vector<Atom*>::iterator getBeginAtomIter() { |
100 |
> |
return atoms_.begin(); |
101 |
> |
} |
102 |
> |
|
103 |
> |
std::vector<Atom*>::iterator getEndAtomIter() { |
104 |
> |
return atoms_.end(); |
105 |
> |
} |
106 |
|
|
107 |
< |
double getZangle( ); |
108 |
< |
void setZangle( double zAng ); |
109 |
< |
void addZangle( double zAng ); |
107 |
> |
/** |
108 |
> |
* Returns the atoms of this rigid body |
109 |
> |
* @return the atoms of this rigid body in a vector |
110 |
> |
* @deprecate |
111 |
> |
*/ |
112 |
> |
std::vector<Atom*> getAtoms() { |
113 |
> |
return atoms_; |
114 |
> |
} |
115 |
|
|
116 |
< |
void calcRefCoords( void ); |
117 |
< |
void doEulerToRotMat(vec3 &euler, mat3x3 &myA ); |
118 |
< |
void calcForcesAndTorques( void ); |
119 |
< |
void updateAtoms( void ); |
116 |
> |
/** |
117 |
> |
* Returns the number of atoms in this rigid body |
118 |
> |
* @return the number of atoms in this rigid body |
119 |
> |
*/ |
120 |
> |
int getNumAtoms() { |
121 |
> |
return atoms_.size(); |
122 |
> |
} |
123 |
|
|
124 |
< |
//void yourAtomsHaveMoved( void ); |
124 |
> |
/** |
125 |
> |
* Return the position of atom which belongs to this rigid body. |
126 |
> |
* @return true if index is valid otherwise return false |
127 |
> |
* @param pos the position of atom which will be set on return if index is valid |
128 |
> |
* @param index the index of the atom in rigid body's private data member atoms_ |
129 |
> |
*/ |
130 |
> |
bool getAtomPos(Vector3d& pos, unsigned int index); |
131 |
|
|
132 |
< |
// Four functions added for derivatives with respect to Euler Angles: |
133 |
< |
// (Needed for minimization routines): |
132 |
> |
/** |
133 |
> |
* Return the position of atom which belongs to this rigid body. |
134 |
> |
* @return true if atom belongs to this rigid body,otherwise return false |
135 |
> |
* @param pos position of atom which will be set on return if atom belongs to this rigid body |
136 |
> |
* @param atom the pointer to an atom |
137 |
> |
*/ |
138 |
> |
bool getAtomPos(Vector3d& pos, Atom* atom); |
139 |
|
|
140 |
< |
void getGrad(double gradient[6] ); |
141 |
< |
void getEulerAngles( double myEuler[3] ); |
142 |
< |
|
143 |
< |
double max(double x, double y); |
144 |
< |
double min(double x, double y); |
140 |
> |
/** |
141 |
> |
* Return the velocity of atom which belongs to this rigid body. |
142 |
> |
* @return true if index is valid otherwise return false |
143 |
> |
* @param vel the velocity of atom which will be set on return if index is valid |
144 |
> |
* @param index the index of the atom in rigid body's private data member atoms_ |
145 |
> |
*/ |
146 |
> |
bool getAtomVel(Vector3d& vel, unsigned int index); |
147 |
|
|
148 |
+ |
/** |
149 |
+ |
* Return the velocity of atom which belongs to this rigid body. |
150 |
+ |
* @return true if atom belongs to this rigid body,otherwise return false |
151 |
+ |
* @param vel velocity of atom which will be set on return if atom belongs to this rigid body |
152 |
+ |
* @param atom the pointer to an atom |
153 |
+ |
*/ |
154 |
+ |
bool getAtomVel(Vector3d& vel, Atom*); |
155 |
|
|
156 |
< |
// utility routines |
156 |
> |
/** |
157 |
> |
* Return the reference coordinate of atom which belongs to this rigid body. |
158 |
> |
* @return true if index is valid otherwise return false |
159 |
> |
* @param coor the reference coordinate of atom which will be set on return if index is valid |
160 |
> |
* @param index the index of the atom in rigid body's private data member atoms_ |
161 |
> |
*/ |
162 |
> |
bool getAtomRefCoor(Vector3d& coor, unsigned int index); |
163 |
|
|
164 |
< |
void findCOM( void ); |
164 |
> |
/** |
165 |
> |
* Return the velocity of atom which belongs to this rigid body. |
166 |
> |
* @return true if atom belongs to this rigid body,otherwise return false |
167 |
> |
* @param coor velocity of atom which will be set on return if atom belongs to this rigid body |
168 |
> |
* @param atom the pointer to an atom |
169 |
> |
*/ |
170 |
> |
bool getAtomRefCoor(Vector3d& coor, Atom* atom); |
171 |
|
|
172 |
< |
virtual void accept(BaseVisitor* v); |
172 |
> |
private: |
173 |
> |
|
174 |
> |
Mat3x3d inertiaTensor_; |
175 |
> |
RotMat3x3d sU_; /**< body fixed standard unit vector */ |
176 |
> |
|
177 |
> |
std::vector<Atom*> atoms_; |
178 |
> |
std::vector<Vector3d> refCoords_; |
179 |
> |
}; |
180 |
|
|
181 |
< |
vector<Atom*> getAtoms() { return myAtoms;} |
99 |
< |
int getNumAtoms() {return myAtoms.size();} |
181 |
> |
}//namepace oopse |
182 |
|
|
183 |
< |
void getAtomPos(double theP[3], int index); |
102 |
< |
void getAtomVel(double theV[3], int index); |
103 |
< |
void getAtomRefCoor(double pos[3], int index); |
104 |
< |
protected: |
183 |
> |
#endif //PRIMITIVES_RIGIDBODY_HPP |
184 |
|
|
106 |
– |
double mass; // the total mass |
107 |
– |
double pos[3]; // the position array (center of mass) |
108 |
– |
double vel[3]; // the velocity array (center of mass) |
109 |
– |
double frc[3]; // the force array (center of mass) |
110 |
– |
double trq[3]; // the torque vector ( space fixed ) |
111 |
– |
double ji[3]; // the angular momentum vector (body fixed) |
112 |
– |
double A[3][3]; // the rotation matrix |
113 |
– |
double I[3][3]; // the inertial tensor (body fixed) |
114 |
– |
double sU[3][3]; // the standard unit vectors (body fixed) |
115 |
– |
double zAngle; // the rotation about the z-axis (body fixed) |
116 |
– |
|
117 |
– |
bool is_linear; |
118 |
– |
int linear_axis; |
119 |
– |
double momIntTol; |
120 |
– |
|
121 |
– |
vector<Atom*> myAtoms; // the vector of atoms |
122 |
– |
vector<vec3> refCoords; |
123 |
– |
vector<mat3x3> refOrients; |
124 |
– |
|
125 |
– |
char rbName[100]; //it will eventually be converted into string |
126 |
– |
}; |
127 |
– |
|
128 |
– |
#endif |