src/constraints/ZconstraintForceManager.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, 234107 (2008).          
 * [4]  Kuang & Gezelter,  J. Chem. Phys. 133, 164101 (2010).
 * [5]  Vardeman, Stocker & Gezelter, J. Chem. Theory Comput. 7, 834 (2011).
 */
 
#ifdef IS_MPI
#include <mpi.h>
#endif
#include <cmath>
#include "constraints/ZconstraintForceManager.hpp"
#include "integrators/Integrator.hpp"
#include "utils/simError.h"
#include "utils/PhysicalConstants.hpp"
#include "utils/StringUtils.hpp"

namespace OpenMD {
  ZconstraintForceManager::ZconstraintForceManager(SimInfo* info): ForceManager(info), infiniteTime(1e31) {
    currSnapshot_ = info_->getSnapshotManager()->getCurrentSnapshot();
    Globals* simParam = info_->getSimParams();

    if (simParam->haveDt()){
      dt_ = simParam->getDt();
    } else {
      sprintf(painCave.errMsg,
              "Integrator Error: dt is not set\n");
      painCave.isFatal = 1;
      simError();    
    }

    if (simParam->haveZconsTime()){
      zconsTime_ = simParam->getZconsTime();
    }
    else{
      sprintf(painCave.errMsg,
              "ZConstraint error: If you use a ZConstraint,\n"
              "\tyou must set zconsTime.\n");
      painCave.isFatal = 1;
      simError();
    }

    if (simParam->haveZconsTol()){
      zconsTol_ = simParam->getZconsTol();
    }
    else{
      zconsTol_ = 0.01;
      sprintf(painCave.errMsg,
              "ZConstraint Warning: Tolerance for z-constraint method is not specified.\n"
              "\tOpenMD will use a default value of %f.\n"
              "\tTo set the tolerance, use the zconsTol variable.\n",
              zconsTol_);
      painCave.isFatal = 0;
      simError();      
    }

    //set zcons gap
    if (simParam->haveZconsGap()){
      usingZconsGap_ = true;
      zconsGap_ = simParam->getZconsGap();
    }else {
      usingZconsGap_ = false;
      zconsGap_ = 0.0;
    }

    //set zcons fixtime
    if (simParam->haveZconsFixtime()){
      zconsFixingTime_ = simParam->getZconsFixtime();
    } else {
      zconsFixingTime_ = infiniteTime;
    }

    //set zconsUsingSMD
    if (simParam->haveZconsUsingSMD()){
      usingSMD_ = simParam->getZconsUsingSMD();
    }else {
      usingSMD_ =false;
    }
    
    zconsOutput_ = getPrefix(info_->getFinalConfigFileName()) + ".fz";

    //estimate the force constant of harmonical potential
    Mat3x3d hmat = currSnapshot_->getHmat();
    RealType halfOfLargestBox = std::max(hmat(0, 0), std::max(hmat(1, 1), hmat(2, 2))) /2;      
    RealType targetTemp;
    if (simParam->haveTargetTemp()) {
      targetTemp = simParam->getTargetTemp();
    } else {
      targetTemp = 298.0;
    }
    RealType zforceConstant = PhysicalConstants::kb * targetTemp / (halfOfLargestBox * halfOfLargestBox);
         
    int nZconstraints = simParam->getNZconsStamps();
    std::vector<ZConsStamp*> stamp = simParam->getZconsStamps();
    //
    for (int i = 0; i < nZconstraints; i++){

      ZconstraintParam param;
      int zmolIndex = stamp[i]->getMolIndex();
      if (stamp[i]->haveZpos()) {
        param.zTargetPos = stamp[i]->getZpos();
      } else {
        param.zTargetPos = getZTargetPos(zmolIndex);
      }

      param.kz = zforceConstant * stamp[i]->getKratio();

      if (stamp[i]->haveCantVel()) {
        param.cantVel = stamp[i]->getCantVel();
      } else {
        param.cantVel = 0.0;
      }

      allZMolIndices_.insert(std::make_pair(zmolIndex, param));
    }

    //create fixedMols_, movingMols_ and unconsMols lists 
    update();
    
    //calculate masss of unconstraint molecules in the whole system (never change during the simulation)
    RealType totMassUnconsMols_local = 0.0;    
    std::vector<Molecule*>::iterator j;
    for ( j = unzconsMols_.begin(); j !=  unzconsMols_.end(); ++j) {
      totMassUnconsMols_local += (*j)->getMass();
    }    
#ifndef IS_MPI
    totMassUnconsMols_ = totMassUnconsMols_local;
#else
    MPI_Allreduce(&totMassUnconsMols_local, &totMassUnconsMols_, 1,
                  MPI_REALTYPE, MPI_SUM, MPI_COMM_WORLD);
#endif

    // creat zconsWriter  
    fzOut = new ZConsWriter(info_, zconsOutput_.c_str());   

    if (!fzOut){
      sprintf(painCave.errMsg, "Fail to create ZConsWriter\n");
      painCave.isFatal = 1;
      simError();
    }

  }

  ZconstraintForceManager::~ZconstraintForceManager(){

    if (fzOut){
      delete fzOut;
    }

  }

  void ZconstraintForceManager::update(){
    fixedZMols_.clear();
    movingZMols_.clear();
    unzconsMols_.clear();

    for (std::map<int, ZconstraintParam>::iterator i = allZMolIndices_.begin(); i != allZMolIndices_.end(); ++i) {
#ifdef IS_MPI
      if (info_->getMolToProc(i->first) == worldRank) {
#endif
        ZconstraintMol zmol;
        zmol.mol = info_->getMoleculeByGlobalIndex(i->first);
        assert(zmol.mol);
        zmol.param = i->second;
        zmol.cantPos = zmol.param.zTargetPos; /**@todo fixed me when zmol migrate, it is incorrect*/
        Vector3d com = zmol.mol->getCom();
        RealType diff = fabs(zmol.param.zTargetPos - com[whichDirection]);
        if (diff < zconsTol_) {
          fixedZMols_.push_back(zmol);
        } else {
          movingZMols_.push_back(zmol);            
        }

#ifdef IS_MPI
      }
#endif
    }

    calcTotalMassMovingZMols();

    std::set<int> zmolSet;
    for (std::list<ZconstraintMol>::iterator i = movingZMols_.begin(); i !=  movingZMols_.end(); ++i) {
      zmolSet.insert(i->mol->getGlobalIndex());
    }    

    for (std::list<ZconstraintMol>::iterator i = fixedZMols_.begin(); i !=  fixedZMols_.end(); ++i) {
      zmolSet.insert(i->mol->getGlobalIndex());
    }

    SimInfo::MoleculeIterator mi;
    Molecule* mol;
    for(mol = info_->beginMolecule(mi); mol != NULL; mol = info_->nextMolecule(mi)) {
      if (zmolSet.find(mol->getGlobalIndex()) == zmolSet.end()) {
        unzconsMols_.push_back(mol);
      }
    }

  }

  bool ZconstraintForceManager::isZMol(Molecule* mol){
    return allZMolIndices_.find(mol->getGlobalIndex()) == allZMolIndices_.end() ? false : true;
  }

  void ZconstraintForceManager::init(){

    //zero out the velocities of center of mass of unconstrained molecules 
    //and the velocities of center of mass of every single z-constrained molecueles
    zeroVelocity();

    currZconsTime_ = currSnapshot_->getTime();
  }

  void ZconstraintForceManager::calcForces(){
    ForceManager::calcForces();
    
    if (usingZconsGap_){
      updateZPos();
    }

    if (checkZConsState()){
      zeroVelocity();    
      calcTotalMassMovingZMols();
    }  

    //do zconstraint force; 
    if (haveFixedZMols()){
      doZconstraintForce();
    }

    //use external force to move the molecules to the specified positions
    if (haveMovingZMols()){
      doHarmonic();
    }

    //write out forces and current positions of z-constraint molecules    
    if (currSnapshot_->getTime() >= currZconsTime_){
      std::list<ZconstraintMol>::iterator i;
      Vector3d com;
      for(i = fixedZMols_.begin(); i != fixedZMols_.end(); ++i) {
        com = i->mol->getCom();
        i->zpos = com[whichDirection];
      }
        
      fzOut->writeFZ(fixedZMols_);
      currZconsTime_ += zconsTime_;
    }
  }

  void ZconstraintForceManager::zeroVelocity(){

    Vector3d comVel;
    Vector3d vel;
    std::list<ZconstraintMol>::iterator i;
    Molecule* mol;
    StuntDouble* sd;
    Molecule::IntegrableObjectIterator ii;

    //zero out the velocities of center of mass of fixed z-constrained molecules
    for(i = fixedZMols_.begin(); i != fixedZMols_.end(); ++i) {

      mol = i->mol;
      comVel = mol->getComVel();

      for(sd = mol->beginIntegrableObject(ii); sd != NULL; 
          sd = mol->nextIntegrableObject(ii)) {

        vel = sd->getVel();  
        vel[whichDirection] -= comVel[whichDirection];
        sd->setVel(vel);
      }
    }

    // calculate the vz of center of mass of moving molecules(include unconstrained molecules 
    // and moving z-constrained molecules)  
    RealType pzMovingMols_local = 0.0;
    RealType pzMovingMols;
    
    for ( i = movingZMols_.begin(); i !=  movingZMols_.end(); ++i) {
      mol = i->mol;        
      comVel = mol->getComVel();
      pzMovingMols_local +=  mol->getMass() * comVel[whichDirection];   
    }

    std::vector<Molecule*>::iterator j;
    for ( j = unzconsMols_.begin(); j !=  unzconsMols_.end(); ++j) {
      mol =*j;
      comVel = mol->getComVel();
      pzMovingMols_local += mol->getMass() * comVel[whichDirection];
    }
    
#ifndef IS_MPI
    pzMovingMols = pzMovingMols_local;
#else
    MPI_Allreduce(&pzMovingMols_local, &pzMovingMols, 1, 
                  MPI_REALTYPE, MPI_SUM, MPI_COMM_WORLD);
#endif

    RealType vzMovingMols = pzMovingMols / (totMassMovingZMols_ + totMassUnconsMols_);

    //modify the velocities of moving z-constrained molecuels
    for ( i = movingZMols_.begin(); i !=  movingZMols_.end(); ++i) {

      mol = i->mol;

      for(sd = mol->beginIntegrableObject(ii); sd != NULL; 
          sd = mol->nextIntegrableObject(ii)) {

        vel = sd->getVel();
        vel[whichDirection] -= vzMovingMols;
        sd->setVel(vel); 
      }
    }

    //modify the velocites of unconstrained molecules  
    for ( j = unzconsMols_.begin(); j !=  unzconsMols_.end(); ++j) {

      mol =*j;

      for(sd = mol->beginIntegrableObject(ii); sd != NULL; 
          sd = mol->nextIntegrableObject(ii)) {

        vel = sd->getVel();
        vel[whichDirection] -= vzMovingMols;
        sd->setVel(vel); 
      }
    }
    
  }


  void ZconstraintForceManager::doZconstraintForce(){
    RealType totalFZ; 
    RealType totalFZ_local;
    Vector3d com;
    Vector3d force(0.0);

    //constrain the molecules which do not reach the specified positions  

    //Zero Out the force of z-contrained molecules    
    totalFZ_local = 0;


    //calculate the total z-contrained force of fixed z-contrained molecules
    std::list<ZconstraintMol>::iterator i;
    Molecule* mol;
    StuntDouble* sd;
    Molecule::IntegrableObjectIterator ii;

    for ( i = fixedZMols_.begin(); i !=  fixedZMols_.end(); ++i) {

      mol = i->mol;
      i->fz = 0.0;

      for( sd = mol->beginIntegrableObject(ii); sd != NULL; 
           sd = mol->nextIntegrableObject(ii)) {

        force = sd->getFrc();    
        i->fz += force[whichDirection]; 
      }
      totalFZ_local += i->fz;
    }

    //calculate total z-constraint force
#ifdef IS_MPI
    MPI_Allreduce(&totalFZ_local, &totalFZ, 1, 
                  MPI_REALTYPE, MPI_SUM, MPI_COMM_WORLD);
#else
    totalFZ = totalFZ_local;
#endif


    // apply negative to fixed z-constrained molecues;
    for ( i = fixedZMols_.begin(); i !=  fixedZMols_.end(); ++i) {

      mol = i->mol;

      for(sd = mol->beginIntegrableObject(ii); sd != NULL; 
          sd = mol->nextIntegrableObject(ii)) {

        force[whichDirection] = -getZFOfFixedZMols(mol, sd, i->fz);
        sd->addFrc(force);
      }
    }

    //modify the forces of moving z-constrained molecules
    for ( i = movingZMols_.begin(); i !=  movingZMols_.end(); ++i) {

      mol = i->mol;

      for(sd = mol->beginIntegrableObject(ii); sd != NULL; 
          sd = mol->nextIntegrableObject(ii)) {

        force[whichDirection] = -getZFOfMovingMols(mol,totalFZ);
        sd->addFrc(force);
      }
    }

    //modify the forces of unconstrained molecules
    std::vector<Molecule*>::iterator j;
    for ( j = unzconsMols_.begin(); j !=  unzconsMols_.end(); ++j) {

      mol =*j;

      for(sd = mol->beginIntegrableObject(ii); sd != NULL; 
          sd = mol->nextIntegrableObject(ii)) {

        force[whichDirection] = -getZFOfMovingMols(mol, totalFZ);
        sd->addFrc(force);
      }
    }

  }


  void ZconstraintForceManager::doHarmonic(){
    RealType totalFZ;
    Vector3d force(0.0);
    Vector3d com;
    RealType totalFZ_local = 0;
    RealType lrPot;
    std::list<ZconstraintMol>::iterator i;
    StuntDouble* sd;
    Molecule::IntegrableObjectIterator ii;
    Molecule* mol;
    for ( i = movingZMols_.begin(); i !=  movingZMols_.end(); ++i) {
      mol = i->mol;
      com = mol->getCom();   
      RealType resPos = usingSMD_? i->cantPos : i->param.zTargetPos;
      RealType diff = com[whichDirection] - resPos; 
      RealType harmonicU = 0.5 * i->param.kz * diff * diff;
      lrPot = currSnapshot_->getLongRangePotential();
      lrPot += harmonicU;
      currSnapshot_->setLongRangePotential(lrPot);
      RealType harmonicF = -i->param.kz * diff;
      totalFZ_local += harmonicF;

      //adjust force
      for(sd = mol->beginIntegrableObject(ii); sd != NULL; 
          sd = mol->nextIntegrableObject(ii)) {

        force[whichDirection] = getHFOfFixedZMols(mol, sd, harmonicF);
        sd->addFrc(force);            
      }
    }

#ifndef IS_MPI
    totalFZ = totalFZ_local;
#else
    MPI_Allreduce(&totalFZ_local, &totalFZ, 1, MPI_REALTYPE, 
                  MPI_SUM, MPI_COMM_WORLD);
#endif

    //modify the forces of unconstrained molecules
    std::vector<Molecule*>::iterator j;
    for ( j = unzconsMols_.begin(); j !=  unzconsMols_.end(); ++j) {

      mol = *j;

      for(sd = mol->beginIntegrableObject(ii); sd != NULL; 
          sd = mol->nextIntegrableObject(ii)) {

        force[whichDirection] = getHFOfUnconsMols(mol, totalFZ);
        sd->addFrc(force);            
      }
    }

  }

  bool ZconstraintForceManager::checkZConsState(){
    Vector3d com;
    RealType diff;
    int changed_local = 0;

    std::list<ZconstraintMol>::iterator i;
    std::list<ZconstraintMol>::iterator j;
    
    std::list<ZconstraintMol> newMovingZMols;
    for ( i = fixedZMols_.begin(); i !=  fixedZMols_.end();) {
      com = i->mol->getCom();
      diff = fabs(com[whichDirection] - i->param.zTargetPos);
      if (diff > zconsTol_) {
        if (usingZconsGap_) {
          i->endFixingTime = infiniteTime;
        }
        j = i++;
        newMovingZMols.push_back(*j);
        fixedZMols_.erase(j);
            
        changed_local = 1;            
      }else {
        ++i;
      }
    }  

    std::list<ZconstraintMol> newFixedZMols;
    for ( i = movingZMols_.begin(); i !=  movingZMols_.end();) {
      com = i->mol->getCom();
      diff = fabs(com[whichDirection] - i->param.zTargetPos);
      if (diff <= zconsTol_) {
        if (usingZconsGap_) {
          i->endFixingTime = currSnapshot_->getTime() + zconsFixingTime_;
        }
        //this moving zconstraint molecule is about to fixed
        //moved this molecule to
        j = i++;
        newFixedZMols.push_back(*j);
        movingZMols_.erase(j);
        changed_local = 1;            
      }else {
        ++i;
      }
    }     

    //merge the lists
    fixedZMols_.insert(fixedZMols_.end(), newFixedZMols.begin(), newFixedZMols.end());
    movingZMols_.insert(movingZMols_.end(), newMovingZMols.begin(), newMovingZMols.end());

    int changed;
#ifndef IS_MPI
    changed = changed_local; 
#else
    MPI_Allreduce(&changed_local, &changed, 1, MPI_INT, MPI_SUM, MPI_COMM_WORLD);
#endif

    return (changed > 0);
  }

  bool ZconstraintForceManager::haveFixedZMols(){
    int havingFixed;
    int havingFixed_local = fixedZMols_.empty() ? 0 : 1;

#ifndef IS_MPI
    havingFixed = havingFixed_local;
#else
    MPI_Allreduce(&havingFixed_local, &havingFixed, 1, 
                  MPI_INT, MPI_SUM, MPI_COMM_WORLD);
#endif

    return havingFixed > 0;
  }


  bool ZconstraintForceManager::haveMovingZMols(){
    int havingMoving_local;
    int havingMoving;

    havingMoving_local = movingZMols_.empty()? 0 : 1;

#ifndef IS_MPI
    havingMoving = havingMoving_local;
#else
    MPI_Allreduce(&havingMoving_local, &havingMoving, 1, 
                  MPI_INT, MPI_SUM, MPI_COMM_WORLD);
#endif

    return havingMoving > 0;
  }

  void ZconstraintForceManager::calcTotalMassMovingZMols(){

    RealType totMassMovingZMols_local = 0.0;
    std::list<ZconstraintMol>::iterator i;
    for ( i = movingZMols_.begin(); i !=  movingZMols_.end(); ++i) {
      totMassMovingZMols_local += i->mol->getMass();
    }
    
#ifdef IS_MPI
    MPI_Allreduce(&totMassMovingZMols_local, &totMassMovingZMols_, 
                  1, MPI_REALTYPE, MPI_SUM, MPI_COMM_WORLD);
#else
    totMassMovingZMols_ = totMassMovingZMols_local;
#endif

  }

  RealType ZconstraintForceManager::getZFOfFixedZMols(Molecule* mol, StuntDouble* sd, RealType totalForce){
    return totalForce * sd->getMass() / mol->getMass();
  }

  RealType ZconstraintForceManager::getZFOfMovingMols(Molecule* mol, RealType totalForce){
    return totalForce * mol->getMass() / (totMassUnconsMols_ + totMassMovingZMols_);
  }

  RealType ZconstraintForceManager::getHFOfFixedZMols(Molecule* mol, StuntDouble*sd, RealType totalForce){
    return totalForce * sd->getMass() / mol->getMass();
  }

  RealType ZconstraintForceManager::getHFOfUnconsMols(Molecule* mol, RealType totalForce){
    return totalForce * mol->getMass() / totMassUnconsMols_;
  }

  void ZconstraintForceManager::updateZPos(){
    std::list<ZconstraintMol>::iterator i;
    for ( i = fixedZMols_.begin(); i !=  fixedZMols_.end(); ++i) {
      i->param.zTargetPos += zconsGap_;     
    }  
  }

  void ZconstraintForceManager::updateCantPos(){
    std::list<ZconstraintMol>::iterator i;
    for ( i = movingZMols_.begin(); i !=  movingZMols_.end(); ++i) {
      i->cantPos += i->param.cantVel * dt_;
    }
  }

  RealType ZconstraintForceManager::getZTargetPos(int index){
    RealType zTargetPos;
#ifndef IS_MPI    
    Molecule* mol = info_->getMoleculeByGlobalIndex(index);
    assert(mol);
    Vector3d com = mol->getCom();
    zTargetPos = com[whichDirection];
#else
    int whicProc = info_->getMolToProc(index);
    MPI_Bcast(&zTargetPos, 1, MPI_REALTYPE, whicProc, MPI_COMM_WORLD);
#endif
    return zTargetPos;
  }

}
Revision:	2067
Committed:	Thu Mar 5 15:35:37 2015 UTC (10 years, 7 months ago) by gezelter
File size:	19190 byte(s)
Log Message:	Trying to eliminate some g++ warnings
#	Content
1	/*
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. Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.
11	*
12	* 2. Redistributions in binary form must reproduce the above copyright
13	* 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	*
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, 234107 (2008).
39	* [4] Kuang & Gezelter, J. Chem. Phys. 133, 164101 (2010).
40	* [5] Vardeman, Stocker & Gezelter, J. Chem. Theory Comput. 7, 834 (2011).
41	*/
42
43	#ifdef IS_MPI
44	#include <mpi.h>
45	#endif
46	#include <cmath>
47	#include "constraints/ZconstraintForceManager.hpp"
48	#include "integrators/Integrator.hpp"
49	#include "utils/simError.h"
50	#include "utils/PhysicalConstants.hpp"
51	#include "utils/StringUtils.hpp"
52
53	namespace OpenMD {
54	ZconstraintForceManager::ZconstraintForceManager(SimInfo* info): ForceManager(info), infiniteTime(1e31) {
55	currSnapshot_ = info_->getSnapshotManager()->getCurrentSnapshot();
56	Globals* simParam = info_->getSimParams();
57
58	if (simParam->haveDt()){
59	dt_ = simParam->getDt();
60	} else {
61	sprintf(painCave.errMsg,
62	"Integrator Error: dt is not set\n");
63	painCave.isFatal = 1;
64	simError();
65	}
66
67	if (simParam->haveZconsTime()){
68	zconsTime_ = simParam->getZconsTime();
69	}
70	else{
71	sprintf(painCave.errMsg,
72	"ZConstraint error: If you use a ZConstraint,\n"
73	"\tyou must set zconsTime.\n");
74	painCave.isFatal = 1;
75	simError();
76	}
77
78	if (simParam->haveZconsTol()){
79	zconsTol_ = simParam->getZconsTol();
80	}
81	else{
82	zconsTol_ = 0.01;
83	sprintf(painCave.errMsg,
84	"ZConstraint Warning: Tolerance for z-constraint method is not specified.\n"
85	"\tOpenMD will use a default value of %f.\n"
86	"\tTo set the tolerance, use the zconsTol variable.\n",
87	zconsTol_);
88	painCave.isFatal = 0;
89	simError();
90	}
91
92	//set zcons gap
93	if (simParam->haveZconsGap()){
94	usingZconsGap_ = true;
95	zconsGap_ = simParam->getZconsGap();
96	}else {
97	usingZconsGap_ = false;
98	zconsGap_ = 0.0;
99	}
100
101	//set zcons fixtime
102	if (simParam->haveZconsFixtime()){
103	zconsFixingTime_ = simParam->getZconsFixtime();
104	} else {
105	zconsFixingTime_ = infiniteTime;
106	}
107
108	//set zconsUsingSMD
109	if (simParam->haveZconsUsingSMD()){
110	usingSMD_ = simParam->getZconsUsingSMD();
111	}else {
112	usingSMD_ =false;
113	}
114
115	zconsOutput_ = getPrefix(info_->getFinalConfigFileName()) + ".fz";
116
117	//estimate the force constant of harmonical potential
118	Mat3x3d hmat = currSnapshot_->getHmat();
119	RealType halfOfLargestBox = std::max(hmat(0, 0), std::max(hmat(1, 1), hmat(2, 2))) /2;
120	RealType targetTemp;
121	if (simParam->haveTargetTemp()) {
122	targetTemp = simParam->getTargetTemp();
123	} else {
124	targetTemp = 298.0;
125	}
126	RealType zforceConstant = PhysicalConstants::kb * targetTemp / (halfOfLargestBox * halfOfLargestBox);
127
128	int nZconstraints = simParam->getNZconsStamps();
129	std::vector<ZConsStamp*> stamp = simParam->getZconsStamps();
130	//
131	for (int i = 0; i < nZconstraints; i++){
132
133	ZconstraintParam param;
134	int zmolIndex = stamp[i]->getMolIndex();
135	if (stamp[i]->haveZpos()) {
136	param.zTargetPos = stamp[i]->getZpos();
137	} else {
138	param.zTargetPos = getZTargetPos(zmolIndex);
139	}
140
141	param.kz = zforceConstant * stamp[i]->getKratio();
142
143	if (stamp[i]->haveCantVel()) {
144	param.cantVel = stamp[i]->getCantVel();
145	} else {
146	param.cantVel = 0.0;
147	}
148
149	allZMolIndices_.insert(std::make_pair(zmolIndex, param));
150	}
151
152	//create fixedMols_, movingMols_ and unconsMols lists
153	update();
154
155	//calculate masss of unconstraint molecules in the whole system (never change during the simulation)
156	RealType totMassUnconsMols_local = 0.0;
157	std::vector<Molecule*>::iterator j;
158	for ( j = unzconsMols_.begin(); j != unzconsMols_.end(); ++j) {
159	totMassUnconsMols_local += (*j)->getMass();
160	}
161	#ifndef IS_MPI
162	totMassUnconsMols_ = totMassUnconsMols_local;
163	#else
164	MPI_Allreduce(&totMassUnconsMols_local, &totMassUnconsMols_, 1,
165	MPI_REALTYPE, MPI_SUM, MPI_COMM_WORLD);
166	#endif
167
168	// creat zconsWriter
169	fzOut = new ZConsWriter(info_, zconsOutput_.c_str());
170
171	if (!fzOut){
172	sprintf(painCave.errMsg, "Fail to create ZConsWriter\n");
173	painCave.isFatal = 1;
174	simError();
175	}
176
177	}
178
179	ZconstraintForceManager::~ZconstraintForceManager(){
180
181	if (fzOut){
182	delete fzOut;
183	}
184
185	}
186
187	void ZconstraintForceManager::update(){
188	fixedZMols_.clear();
189	movingZMols_.clear();
190	unzconsMols_.clear();
191
192	for (std::map<int, ZconstraintParam>::iterator i = allZMolIndices_.begin(); i != allZMolIndices_.end(); ++i) {
193	#ifdef IS_MPI
194	if (info_->getMolToProc(i->first) == worldRank) {
195	#endif
196	ZconstraintMol zmol;
197	zmol.mol = info_->getMoleculeByGlobalIndex(i->first);
198	assert(zmol.mol);
199	zmol.param = i->second;
200	zmol.cantPos = zmol.param.zTargetPos; /*@todo fixed me when zmol migrate, it is incorrect/
201	Vector3d com = zmol.mol->getCom();
202	RealType diff = fabs(zmol.param.zTargetPos - com[whichDirection]);
203	if (diff < zconsTol_) {
204	fixedZMols_.push_back(zmol);
205	} else {
206	movingZMols_.push_back(zmol);
207	}
208
209	#ifdef IS_MPI
210	}
211	#endif
212	}
213
214	calcTotalMassMovingZMols();
215
216	std::set<int> zmolSet;
217	for (std::list<ZconstraintMol>::iterator i = movingZMols_.begin(); i != movingZMols_.end(); ++i) {
218	zmolSet.insert(i->mol->getGlobalIndex());
219	}
220
221	for (std::list<ZconstraintMol>::iterator i = fixedZMols_.begin(); i != fixedZMols_.end(); ++i) {
222	zmolSet.insert(i->mol->getGlobalIndex());
223	}
224
225	SimInfo::MoleculeIterator mi;
226	Molecule* mol;
227	for(mol = info_->beginMolecule(mi); mol != NULL; mol = info_->nextMolecule(mi)) {
228	if (zmolSet.find(mol->getGlobalIndex()) == zmolSet.end()) {
229	unzconsMols_.push_back(mol);
230	}
231	}
232
233	}
234
235	bool ZconstraintForceManager::isZMol(Molecule* mol){
236	return allZMolIndices_.find(mol->getGlobalIndex()) == allZMolIndices_.end() ? false : true;
237	}
238
239	void ZconstraintForceManager::init(){
240
241	//zero out the velocities of center of mass of unconstrained molecules
242	//and the velocities of center of mass of every single z-constrained molecueles
243	zeroVelocity();
244
245	currZconsTime_ = currSnapshot_->getTime();
246	}
247
248	void ZconstraintForceManager::calcForces(){
249	ForceManager::calcForces();
250
251	if (usingZconsGap_){
252	updateZPos();
253	}
254
255	if (checkZConsState()){
256	zeroVelocity();
257	calcTotalMassMovingZMols();
258	}
259
260	//do zconstraint force;
261	if (haveFixedZMols()){
262	doZconstraintForce();
263	}
264
265	//use external force to move the molecules to the specified positions
266	if (haveMovingZMols()){
267	doHarmonic();
268	}
269
270	//write out forces and current positions of z-constraint molecules
271	if (currSnapshot_->getTime() >= currZconsTime_){
272	std::list<ZconstraintMol>::iterator i;
273	Vector3d com;
274	for(i = fixedZMols_.begin(); i != fixedZMols_.end(); ++i) {
275	com = i->mol->getCom();
276	i->zpos = com[whichDirection];
277	}
278
279	fzOut->writeFZ(fixedZMols_);
280	currZconsTime_ += zconsTime_;
281	}
282	}
283
284	void ZconstraintForceManager::zeroVelocity(){
285
286	Vector3d comVel;
287	Vector3d vel;
288	std::list<ZconstraintMol>::iterator i;
289	Molecule* mol;
290	StuntDouble* sd;
291	Molecule::IntegrableObjectIterator ii;
292
293	//zero out the velocities of center of mass of fixed z-constrained molecules
294	for(i = fixedZMols_.begin(); i != fixedZMols_.end(); ++i) {
295
296	mol = i->mol;
297	comVel = mol->getComVel();
298
299	for(sd = mol->beginIntegrableObject(ii); sd != NULL;
300	sd = mol->nextIntegrableObject(ii)) {
301
302	vel = sd->getVel();
303	vel[whichDirection] -= comVel[whichDirection];
304	sd->setVel(vel);
305	}
306	}
307
308	// calculate the vz of center of mass of moving molecules(include unconstrained molecules
309	// and moving z-constrained molecules)
310	RealType pzMovingMols_local = 0.0;
311	RealType pzMovingMols;
312
313	for ( i = movingZMols_.begin(); i != movingZMols_.end(); ++i) {
314	mol = i->mol;
315	comVel = mol->getComVel();
316	pzMovingMols_local += mol->getMass() * comVel[whichDirection];
317	}
318
319	std::vector<Molecule*>::iterator j;
320	for ( j = unzconsMols_.begin(); j != unzconsMols_.end(); ++j) {
321	mol =*j;
322	comVel = mol->getComVel();
323	pzMovingMols_local += mol->getMass() * comVel[whichDirection];
324	}
325
326	#ifndef IS_MPI
327	pzMovingMols = pzMovingMols_local;
328	#else
329	MPI_Allreduce(&pzMovingMols_local, &pzMovingMols, 1,
330	MPI_REALTYPE, MPI_SUM, MPI_COMM_WORLD);
331	#endif
332
333	RealType vzMovingMols = pzMovingMols / (totMassMovingZMols_ + totMassUnconsMols_);
334
335	//modify the velocities of moving z-constrained molecuels
336	for ( i = movingZMols_.begin(); i != movingZMols_.end(); ++i) {
337
338	mol = i->mol;
339
340	for(sd = mol->beginIntegrableObject(ii); sd != NULL;
341	sd = mol->nextIntegrableObject(ii)) {
342
343	vel = sd->getVel();
344	vel[whichDirection] -= vzMovingMols;
345	sd->setVel(vel);
346	}
347	}
348
349	//modify the velocites of unconstrained molecules
350	for ( j = unzconsMols_.begin(); j != unzconsMols_.end(); ++j) {
351
352	mol =*j;
353
354	for(sd = mol->beginIntegrableObject(ii); sd != NULL;
355	sd = mol->nextIntegrableObject(ii)) {
356
357	vel = sd->getVel();
358	vel[whichDirection] -= vzMovingMols;
359	sd->setVel(vel);
360	}
361	}
362
363	}
364
365
366	void ZconstraintForceManager::doZconstraintForce(){
367	RealType totalFZ;
368	RealType totalFZ_local;
369	Vector3d com;
370	Vector3d force(0.0);
371
372	//constrain the molecules which do not reach the specified positions
373
374	//Zero Out the force of z-contrained molecules
375	totalFZ_local = 0;
376
377
378	//calculate the total z-contrained force of fixed z-contrained molecules
379	std::list<ZconstraintMol>::iterator i;
380	Molecule* mol;
381	StuntDouble* sd;
382	Molecule::IntegrableObjectIterator ii;
383
384	for ( i = fixedZMols_.begin(); i != fixedZMols_.end(); ++i) {
385
386	mol = i->mol;
387	i->fz = 0.0;
388
389	for( sd = mol->beginIntegrableObject(ii); sd != NULL;
390	sd = mol->nextIntegrableObject(ii)) {
391
392	force = sd->getFrc();
393	i->fz += force[whichDirection];
394	}
395	totalFZ_local += i->fz;
396	}
397
398	//calculate total z-constraint force
399	#ifdef IS_MPI
400	MPI_Allreduce(&totalFZ_local, &totalFZ, 1,
401	MPI_REALTYPE, MPI_SUM, MPI_COMM_WORLD);
402	#else
403	totalFZ = totalFZ_local;
404	#endif
405
406
407	// apply negative to fixed z-constrained molecues;
408	for ( i = fixedZMols_.begin(); i != fixedZMols_.end(); ++i) {
409
410	mol = i->mol;
411
412	for(sd = mol->beginIntegrableObject(ii); sd != NULL;
413	sd = mol->nextIntegrableObject(ii)) {
414
415	force[whichDirection] = -getZFOfFixedZMols(mol, sd, i->fz);
416	sd->addFrc(force);
417	}
418	}
419
420	//modify the forces of moving z-constrained molecules
421	for ( i = movingZMols_.begin(); i != movingZMols_.end(); ++i) {
422
423	mol = i->mol;
424
425	for(sd = mol->beginIntegrableObject(ii); sd != NULL;
426	sd = mol->nextIntegrableObject(ii)) {
427
428	force[whichDirection] = -getZFOfMovingMols(mol,totalFZ);
429	sd->addFrc(force);
430	}
431	}
432
433	//modify the forces of unconstrained molecules
434	std::vector<Molecule*>::iterator j;
435	for ( j = unzconsMols_.begin(); j != unzconsMols_.end(); ++j) {
436
437	mol =*j;
438
439	for(sd = mol->beginIntegrableObject(ii); sd != NULL;
440	sd = mol->nextIntegrableObject(ii)) {
441
442	force[whichDirection] = -getZFOfMovingMols(mol, totalFZ);
443	sd->addFrc(force);
444	}
445	}
446
447	}
448
449
450	void ZconstraintForceManager::doHarmonic(){
451	RealType totalFZ;
452	Vector3d force(0.0);
453	Vector3d com;
454	RealType totalFZ_local = 0;
455	RealType lrPot;
456	std::list<ZconstraintMol>::iterator i;
457	StuntDouble* sd;
458	Molecule::IntegrableObjectIterator ii;
459	Molecule* mol;
460	for ( i = movingZMols_.begin(); i != movingZMols_.end(); ++i) {
461	mol = i->mol;
462	com = mol->getCom();
463	RealType resPos = usingSMD_? i->cantPos : i->param.zTargetPos;
464	RealType diff = com[whichDirection] - resPos;
465	RealType harmonicU = 0.5 * i->param.kz * diff * diff;
466	lrPot = currSnapshot_->getLongRangePotential();
467	lrPot += harmonicU;
468	currSnapshot_->setLongRangePotential(lrPot);
469	RealType harmonicF = -i->param.kz * diff;
470	totalFZ_local += harmonicF;
471
472	//adjust force
473	for(sd = mol->beginIntegrableObject(ii); sd != NULL;
474	sd = mol->nextIntegrableObject(ii)) {
475
476	force[whichDirection] = getHFOfFixedZMols(mol, sd, harmonicF);
477	sd->addFrc(force);
478	}
479	}
480
481	#ifndef IS_MPI
482	totalFZ = totalFZ_local;
483	#else
484	MPI_Allreduce(&totalFZ_local, &totalFZ, 1, MPI_REALTYPE,
485	MPI_SUM, MPI_COMM_WORLD);
486	#endif
487
488	//modify the forces of unconstrained molecules
489	std::vector<Molecule*>::iterator j;
490	for ( j = unzconsMols_.begin(); j != unzconsMols_.end(); ++j) {
491
492	mol = *j;
493
494	for(sd = mol->beginIntegrableObject(ii); sd != NULL;
495	sd = mol->nextIntegrableObject(ii)) {
496
497	force[whichDirection] = getHFOfUnconsMols(mol, totalFZ);
498	sd->addFrc(force);
499	}
500	}
501
502	}
503
504	bool ZconstraintForceManager::checkZConsState(){
505	Vector3d com;
506	RealType diff;
507	int changed_local = 0;
508
509	std::list<ZconstraintMol>::iterator i;
510	std::list<ZconstraintMol>::iterator j;
511
512	std::list<ZconstraintMol> newMovingZMols;
513	for ( i = fixedZMols_.begin(); i != fixedZMols_.end();) {
514	com = i->mol->getCom();
515	diff = fabs(com[whichDirection] - i->param.zTargetPos);
516	if (diff > zconsTol_) {
517	if (usingZconsGap_) {
518	i->endFixingTime = infiniteTime;
519	}
520	j = i++;
521	newMovingZMols.push_back(*j);
522	fixedZMols_.erase(j);
523
524	changed_local = 1;
525	}else {
526	++i;
527	}
528	}
529
530	std::list<ZconstraintMol> newFixedZMols;
531	for ( i = movingZMols_.begin(); i != movingZMols_.end();) {
532	com = i->mol->getCom();
533	diff = fabs(com[whichDirection] - i->param.zTargetPos);
534	if (diff <= zconsTol_) {
535	if (usingZconsGap_) {
536	i->endFixingTime = currSnapshot_->getTime() + zconsFixingTime_;
537	}
538	//this moving zconstraint molecule is about to fixed
539	//moved this molecule to
540	j = i++;
541	newFixedZMols.push_back(*j);
542	movingZMols_.erase(j);
543	changed_local = 1;
544	}else {
545	++i;
546	}
547	}
548
549	//merge the lists
550	fixedZMols_.insert(fixedZMols_.end(), newFixedZMols.begin(), newFixedZMols.end());
551	movingZMols_.insert(movingZMols_.end(), newMovingZMols.begin(), newMovingZMols.end());
552
553	int changed;
554	#ifndef IS_MPI
555	changed = changed_local;
556	#else
557	MPI_Allreduce(&changed_local, &changed, 1, MPI_INT, MPI_SUM, MPI_COMM_WORLD);
558	#endif
559
560	return (changed > 0);
561	}
562
563	bool ZconstraintForceManager::haveFixedZMols(){
564	int havingFixed;
565	int havingFixed_local = fixedZMols_.empty() ? 0 : 1;
566
567	#ifndef IS_MPI
568	havingFixed = havingFixed_local;
569	#else
570	MPI_Allreduce(&havingFixed_local, &havingFixed, 1,
571	MPI_INT, MPI_SUM, MPI_COMM_WORLD);
572	#endif
573
574	return havingFixed > 0;
575	}
576
577
578	bool ZconstraintForceManager::haveMovingZMols(){
579	int havingMoving_local;
580	int havingMoving;
581
582	havingMoving_local = movingZMols_.empty()? 0 : 1;
583
584	#ifndef IS_MPI
585	havingMoving = havingMoving_local;
586	#else
587	MPI_Allreduce(&havingMoving_local, &havingMoving, 1,
588	MPI_INT, MPI_SUM, MPI_COMM_WORLD);
589	#endif
590
591	return havingMoving > 0;
592	}
593
594	void ZconstraintForceManager::calcTotalMassMovingZMols(){
595
596	RealType totMassMovingZMols_local = 0.0;
597	std::list<ZconstraintMol>::iterator i;
598	for ( i = movingZMols_.begin(); i != movingZMols_.end(); ++i) {
599	totMassMovingZMols_local += i->mol->getMass();
600	}
601
602	#ifdef IS_MPI
603	MPI_Allreduce(&totMassMovingZMols_local, &totMassMovingZMols_,
604	1, MPI_REALTYPE, MPI_SUM, MPI_COMM_WORLD);
605	#else
606	totMassMovingZMols_ = totMassMovingZMols_local;
607	#endif
608
609	}
610
611	RealType ZconstraintForceManager::getZFOfFixedZMols(Molecule* mol, StuntDouble* sd, RealType totalForce){
612	return totalForce * sd->getMass() / mol->getMass();
613	}
614
615	RealType ZconstraintForceManager::getZFOfMovingMols(Molecule* mol, RealType totalForce){
616	return totalForce * mol->getMass() / (totMassUnconsMols_ + totMassMovingZMols_);
617	}
618
619	RealType ZconstraintForceManager::getHFOfFixedZMols(Molecule* mol, StuntDouble*sd, RealType totalForce){
620	return totalForce * sd->getMass() / mol->getMass();
621	}
622
623	RealType ZconstraintForceManager::getHFOfUnconsMols(Molecule* mol, RealType totalForce){
624	return totalForce * mol->getMass() / totMassUnconsMols_;
625	}
626
627	void ZconstraintForceManager::updateZPos(){
628	std::list<ZconstraintMol>::iterator i;
629	for ( i = fixedZMols_.begin(); i != fixedZMols_.end(); ++i) {
630	i->param.zTargetPos += zconsGap_;
631	}
632	}
633
634	void ZconstraintForceManager::updateCantPos(){
635	std::list<ZconstraintMol>::iterator i;
636	for ( i = movingZMols_.begin(); i != movingZMols_.end(); ++i) {
637	i->cantPos += i->param.cantVel * dt_;
638	}
639	}
640
641	RealType ZconstraintForceManager::getZTargetPos(int index){
642	RealType zTargetPos;
643	#ifndef IS_MPI
644	Molecule* mol = info_->getMoleculeByGlobalIndex(index);
645	assert(mol);
646	Vector3d com = mol->getCom();
647	zTargetPos = com[whichDirection];
648	#else
649	int whicProc = info_->getMolToProc(index);
650	MPI_Bcast(&zTargetPos, 1, MPI_REALTYPE, whicProc, MPI_COMM_WORLD);
651	#endif
652	return zTargetPos;
653	}
654
655	}