src/utils/MoLocator.cpp

/*
 * Copyright (c) 2005 The University of Notre Dame. All Rights Reserved.
 *
 * The University of Notre Dame grants you ("Licensee") a
 * non-exclusive, royalty free, license to use, modify and
 * redistribute this software in source and binary code form, provided
 * that the following conditions are met:
 *
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 *
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the
 *    distribution.
 *
 * This software is provided "AS IS," without a warranty of any
 * kind. All express or implied conditions, representations and
 * warranties, including any implied warranty of merchantability,
 * fitness for a particular purpose or non-infringement, are hereby
 * excluded.  The University of Notre Dame and its licensors shall not
 * be liable for any damages suffered by licensee as a result of
 * using, modifying or distributing the software or its
 * derivatives. In no event will the University of Notre Dame or its
 * licensors be liable for any lost revenue, profit or data, or for
 * direct, indirect, special, consequential, incidental or punitive
 * damages, however caused and regardless of the theory of liability,
 * arising out of the use of or inability to use software, even if the
 * University of Notre Dame has been advised of the possibility of
 * such damages.
 *
 * SUPPORT OPEN SCIENCE!  If you use OpenMD or its source code in your
 * research, please cite the appropriate papers when you publish your
 * work.  Good starting points are:
 *                                                                      
 * [1]  Meineke, et al., J. Comp. Chem. 26, 252-271 (2005).             
 * [2]  Fennell & Gezelter, J. Chem. Phys. 124, 234104 (2006).          
 * [3]  Sun, Lin & Gezelter, J. Chem. Phys. 128, 24107 (2008).          
 * [4]  Kuang & Gezelter,  J. Chem. Phys. 133, 164101 (2010).
 * [5]  Vardeman, Stocker & Gezelter, J. Chem. Theory Comput. 7, 834 (2011).
 */
 
#include <iostream>

#include <cstdlib>
#include <cmath>

#include "utils/simError.h"
#include "utils/MoLocator.hpp"
#include "types/AtomType.hpp"

namespace OpenMD {
  MoLocator::MoLocator( MoleculeStamp* theStamp, ForceField* theFF){
    
    myStamp = theStamp;
    myFF = theFF;
    nIntegrableObjects = myStamp->getNIntegrable();
    calcRef();
  }
  
  void MoLocator::placeMol( const Vector3d& offset, const Vector3d& ort, Molecule* mol){

    Vector3d newCoor;
    Vector3d curRefCoor;  
    RotMat3x3d rotMat = latVec2RotMat(ort);
    
    if(mol->getNIntegrableObjects() != nIntegrableObjects){
      sprintf( painCave.errMsg,
               "MoLocator error.\n"
               "  The number of integrable objects of MoleculeStamp is not the same as  that of Molecule\n");
      painCave.isFatal = 1;
      simError();
    }
    
    Molecule::IntegrableObjectIterator ii;
    StuntDouble* sd;
    int i;
    for (sd = mol->beginIntegrableObject(ii), i = 0; sd != NULL; 
         sd = mol->nextIntegrableObject(ii), ++i) { 
      
      newCoor = rotMat * refCoords[i];
      newCoor += offset;
     
      sd->setPos(newCoor);
      sd->setVel(V3Zero);
      
      if(sd->isDirectional()){
        sd->setA(rotMat * sd->getA());
        sd->setJ(V3Zero);  
      }        
    }
  }
  
  void MoLocator::calcRef( void ){
    AtomStamp* currAtomStamp;
    RigidBodyStamp* rbStamp;
    unsigned int nAtoms; 
    int nRigidBodies;
    std::vector<RealType> mass;
    Vector3d coor;
    Vector3d refMolCom;  
    int nAtomsInRb;
    RealType totMassInRb;
    RealType currAtomMass;
    RealType molMass;
    
    nAtoms= myStamp->getNAtoms();
    nRigidBodies = myStamp->getNRigidBodies();
    
    for(unsigned int i = 0; i < nAtoms; i++){
      
      currAtomStamp = myStamp->getAtomStamp(i);
      
      if( !currAtomStamp->havePosition() ){
        sprintf( painCave.errMsg,
                 "MoLocator error.\n"
                 "  Component %s, atom %s does not have a position specified.\n"
                 "  This means MoLocator cannot initalize it's position.\n",
                 myStamp->getName().c_str(),
                 currAtomStamp->getType().c_str());
        
        painCave.isFatal = 1;
        simError();
      }
      
      //if atom belongs to rigidbody, just skip it
      if(myStamp->isAtomInRigidBody(i))
        continue;
      //get mass and the reference coordinate 
      else{
        currAtomMass = getAtomMass(currAtomStamp->getType(), myFF);   
        mass.push_back(currAtomMass);
        coor.x() = currAtomStamp->getPosX();
        coor.y() = currAtomStamp->getPosY();
        coor.z() = currAtomStamp->getPosZ();
        refCoords.push_back(coor);
        
      }
    }
    
    for(int i = 0; i < nRigidBodies; i++){
      
      rbStamp = myStamp->getRigidBodyStamp(i);
      nAtomsInRb = rbStamp->getNMembers();
      
      coor.x() = 0.0;
      coor.y() = 0.0;
      coor.z() = 0.0;
      totMassInRb = 0.0;
      
      for(int j = 0; j < nAtomsInRb; j++){
        
        currAtomStamp = myStamp->getAtomStamp(rbStamp->getMemberAt(j));
        currAtomMass = getAtomMass(currAtomStamp->getType(), myFF);
        totMassInRb +=  currAtomMass;
        
        coor.x() += currAtomStamp->getPosX() * currAtomMass;
        coor.y() += currAtomStamp->getPosY() * currAtomMass;
        coor.z() += currAtomStamp->getPosZ() * currAtomMass;
      }
      
      mass.push_back(totMassInRb);
      coor /= totMassInRb;
      refCoords.push_back(coor);
    }
    
    
    //calculate the reference center of mass
    molMass = 0;
    refMolCom.x() = 0;
    refMolCom.y() = 0;
    refMolCom.z() = 0;
    
    for(int i = 0; i < nIntegrableObjects; i++){
      refMolCom += refCoords[i] * mass[i];
      molMass += mass[i];
    }
    
    refMolCom /= molMass;
    
    //move the reference center of mass to (0,0,0) and adjust the reference coordinate 
    //of the integrabel objects
    for(int i = 0; i < nIntegrableObjects; i++)
      refCoords[i] -= refMolCom;
  }
  
  RealType getAtomMass(const std::string& at, ForceField* myFF) {
    RealType mass;
    AtomType* atomType= myFF->getAtomType(at);
    if (atomType != NULL) {
      mass =     atomType->getMass();
    } else {
      mass = 0.0;
      std::cerr << "Can not find AtomType: " << at << std::endl;
    }
    return mass;
  }
  
  RealType getMolMass(MoleculeStamp *molStamp, ForceField *myFF) {
    unsigned int nAtoms;
    RealType totMass = 0;
    nAtoms = molStamp->getNAtoms();
    
    for(unsigned int i = 0; i < nAtoms; i++) {
      AtomStamp *currAtomStamp = molStamp->getAtomStamp(i);
      totMass += getAtomMass(currAtomStamp->getType(), myFF);         
    }
    return totMass;
  }
  RotMat3x3d latVec2RotMat(const Vector3d& lv){
    
    RealType theta =acos(lv[2]);
    RealType phi = atan2(lv[1], lv[0]);
    RealType psi = 0;
    
    return RotMat3x3d(phi, theta, psi);
    
  }
}

Revision:	1769
Committed:	Mon Jul 9 14:15:52 2012 UTC (12 years, 9 months ago) by gezelter
File size:	7107 byte(s)
Log Message:	Code readability updates.
#	User	Rev	Content
1	gezelter	507	/*
2	gezelter	483	* 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	gezelter	1390	* 1. Redistributions of source code must retain the above copyright
10	gezelter	483	* notice, this list of conditions and the following disclaimer.
11			*
12	gezelter	1390	* 2. Redistributions in binary form must reproduce the above copyright
13	gezelter	483	* notice, this list of conditions and the following disclaimer in the
14			* documentation and/or other materials provided with the
15			* distribution.
16			*
17			* This software is provided "AS IS," without a warranty of any
18			* kind. All express or implied conditions, representations and
19			* warranties, including any implied warranty of merchantability,
20			* fitness for a particular purpose or non-infringement, are hereby
21			* excluded. The University of Notre Dame and its licensors shall not
22			* be liable for any damages suffered by licensee as a result of
23			* using, modifying or distributing the software or its
24			* derivatives. In no event will the University of Notre Dame or its
25			* licensors be liable for any lost revenue, profit or data, or for
26			* direct, indirect, special, consequential, incidental or punitive
27			* damages, however caused and regardless of the theory of liability,
28			* arising out of the use of or inability to use software, even if the
29			* University of Notre Dame has been advised of the possibility of
30			* such damages.
31	gezelter	1390	*
32			* SUPPORT OPEN SCIENCE! If you use OpenMD or its source code in your
33			* research, please cite the appropriate papers when you publish your
34			* work. Good starting points are:
35			*
36			* [1] Meineke, et al., J. Comp. Chem. 26, 252-271 (2005).
37			* [2] Fennell & Gezelter, J. Chem. Phys. 124, 234104 (2006).
38			* [3] Sun, Lin & Gezelter, J. Chem. Phys. 128, 24107 (2008).
39	gezelter	1665	* [4] Kuang & Gezelter, J. Chem. Phys. 133, 164101 (2010).
40			* [5] Vardeman, Stocker & Gezelter, J. Chem. Theory Comput. 7, 834 (2011).
41	gezelter	483	*/
42
43			#include <iostream>
44
45			#include <cstdlib>
46			#include <cmath>
47
48			#include "utils/simError.h"
49			#include "utils/MoLocator.hpp"
50			#include "types/AtomType.hpp"
51	gezelter	501
52	gezelter	1390	namespace OpenMD {
53	gezelter	501	MoLocator::MoLocator( MoleculeStamp* theStamp, ForceField* theFF){
54
55			myStamp = theStamp;
56			myFF = theFF;
57			nIntegrableObjects = myStamp->getNIntegrable();
58			calcRef();
59			}
60
61			void MoLocator::placeMol( const Vector3d& offset, const Vector3d& ort, Molecule* mol){
62	gezelter	1062
63	gezelter	483	Vector3d newCoor;
64			Vector3d curRefCoor;
65			RotMat3x3d rotMat = latVec2RotMat(ort);
66	gezelter	501
67	gezelter	483	if(mol->getNIntegrableObjects() != nIntegrableObjects){
68	gezelter	501	sprintf( painCave.errMsg,
69			"MoLocator error.\n"
70			" The number of integrable objects of MoleculeStamp is not the same as that of Molecule\n");
71			painCave.isFatal = 1;
72			simError();
73	gezelter	483	}
74	gezelter	501
75	gezelter	483	Molecule::IntegrableObjectIterator ii;
76	gezelter	1769	StuntDouble* sd;
77	gezelter	483	int i;
78	gezelter	1769	for (sd = mol->beginIntegrableObject(ii), i = 0; sd != NULL;
79			sd = mol->nextIntegrableObject(ii), ++i) {
80	gezelter	501
81			newCoor = rotMat * refCoords[i];
82			newCoor += offset;
83	gezelter	1062
84	gezelter	1769	sd->setPos(newCoor);
85			sd->setVel(V3Zero);
86	gezelter	501
87	gezelter	1769	if(sd->isDirectional()){
88			sd->setA(rotMat * sd->getA());
89			sd->setJ(V3Zero);
90	gezelter	501	}
91	gezelter	483	}
92	gezelter	501	}
93	gezelter	483
94	gezelter	501	void MoLocator::calcRef( void ){
95			AtomStamp* currAtomStamp;
96			RigidBodyStamp* rbStamp;
97	gezelter	1767	unsigned int nAtoms;
98	gezelter	501	int nRigidBodies;
99	tim	963	std::vector<RealType> mass;
100	gezelter	501	Vector3d coor;
101			Vector3d refMolCom;
102			int nAtomsInRb;
103	tim	963	RealType totMassInRb;
104			RealType currAtomMass;
105			RealType molMass;
106	gezelter	501
107			nAtoms= myStamp->getNAtoms();
108			nRigidBodies = myStamp->getNRigidBodies();
109
110	gezelter	1767	for(unsigned int i = 0; i < nAtoms; i++){
111	gezelter	501
112	tim	770	currAtomStamp = myStamp->getAtomStamp(i);
113	gezelter	501
114			if( !currAtomStamp->havePosition() ){
115			sprintf( painCave.errMsg,
116			"MoLocator error.\n"
117			" Component %s, atom %s does not have a position specified.\n"
118			" This means MoLocator cannot initalize it's position.\n",
119	tim	770	myStamp->getName().c_str(),
120			currAtomStamp->getType().c_str());
121	gezelter	501
122			painCave.isFatal = 1;
123			simError();
124			}
125
126			//if atom belongs to rigidbody, just skip it
127			if(myStamp->isAtomInRigidBody(i))
128			continue;
129			//get mass and the reference coordinate
130			else{
131			currAtomMass = getAtomMass(currAtomStamp->getType(), myFF);
132			mass.push_back(currAtomMass);
133			coor.x() = currAtomStamp->getPosX();
134			coor.y() = currAtomStamp->getPosY();
135			coor.z() = currAtomStamp->getPosZ();
136			refCoords.push_back(coor);
137
138			}
139	gezelter	483	}
140	gezelter	501
141			for(int i = 0; i < nRigidBodies; i++){
142
143	tim	770	rbStamp = myStamp->getRigidBodyStamp(i);
144	gezelter	501	nAtomsInRb = rbStamp->getNMembers();
145
146			coor.x() = 0.0;
147			coor.y() = 0.0;
148			coor.z() = 0.0;
149			totMassInRb = 0.0;
150
151			for(int j = 0; j < nAtomsInRb; j++){
152
153	tim	770	currAtomStamp = myStamp->getAtomStamp(rbStamp->getMemberAt(j));
154	gezelter	501	currAtomMass = getAtomMass(currAtomStamp->getType(), myFF);
155			totMassInRb += currAtomMass;
156
157			coor.x() += currAtomStamp->getPosX() * currAtomMass;
158			coor.y() += currAtomStamp->getPosY() * currAtomMass;
159			coor.z() += currAtomStamp->getPosZ() * currAtomMass;
160			}
161
162			mass.push_back(totMassInRb);
163			coor /= totMassInRb;
164	gezelter	483	refCoords.push_back(coor);
165			}
166	gezelter	501
167
168			//calculate the reference center of mass
169			molMass = 0;
170			refMolCom.x() = 0;
171			refMolCom.y() = 0;
172			refMolCom.z() = 0;
173
174			for(int i = 0; i < nIntegrableObjects; i++){
175			refMolCom += refCoords[i] * mass[i];
176			molMass += mass[i];
177	gezelter	483	}
178	gezelter	501
179			refMolCom /= molMass;
180
181			//move the reference center of mass to (0,0,0) and adjust the reference coordinate
182			//of the integrabel objects
183	gezelter	507	for(int i = 0; i < nIntegrableObjects; i++)
184			refCoords[i] -= refMolCom;
185	gezelter	483	}
186
187	tim	963	RealType getAtomMass(const std::string& at, ForceField* myFF) {
188			RealType mass;
189	gezelter	483	AtomType* atomType= myFF->getAtomType(at);
190			if (atomType != NULL) {
191	gezelter	501	mass = atomType->getMass();
192	gezelter	483	} else {
193	gezelter	501	mass = 0.0;
194			std::cerr << "Can not find AtomType: " << at << std::endl;
195	gezelter	483	}
196			return mass;
197	gezelter	501	}
198
199	tim	963	RealType getMolMass(MoleculeStamp molStamp, ForceField myFF) {
200	gezelter	1767	unsigned int nAtoms;
201	tim	963	RealType totMass = 0;
202	gezelter	483	nAtoms = molStamp->getNAtoms();
203	gezelter	501
204	gezelter	1767	for(unsigned int i = 0; i < nAtoms; i++) {
205	tim	770	AtomStamp *currAtomStamp = molStamp->getAtomStamp(i);
206	gezelter	501	totMass += getAtomMass(currAtomStamp->getType(), myFF);
207	gezelter	483	}
208			return totMass;
209	gezelter	501	}
210			RotMat3x3d latVec2RotMat(const Vector3d& lv){
211
212	tim	963	RealType theta =acos(lv[2]);
213			RealType phi = atan2(lv[1], lv[0]);
214			RealType psi = 0;
215	gezelter	501
216	gezelter	483	return RotMat3x3d(phi, theta, psi);
217	gezelter	501
218			}
219	gezelter	483	}
220