| 1 |
/* |
| 2 |
* Copyright (c) 2009 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, 24107 (2008). |
| 39 |
* [4] Vardeman & Gezelter, in progress (2009). |
| 40 |
*/ |
| 41 |
|
| 42 |
#include "restraints/MolecularRestraint.hpp" |
| 43 |
#include "math/SquareMatrix3.hpp" |
| 44 |
#include "math/SVD.hpp" |
| 45 |
#include <utility> |
| 46 |
|
| 47 |
//using namespace JAMA; |
| 48 |
|
| 49 |
namespace OpenMD { |
| 50 |
|
| 51 |
void MolecularRestraint::calcForce(std::vector<Vector3d> struc, |
| 52 |
Vector3d molCom){ |
| 53 |
|
| 54 |
assert(struc.size() == ref_.size()); |
| 55 |
|
| 56 |
std::vector<Vector3d>::iterator it; |
| 57 |
|
| 58 |
// clear out initial values: |
| 59 |
pot_ = 0.0; |
| 60 |
for(it = forces_.begin(); it != forces_.end(); ++it) |
| 61 |
(*it) = 0.0; |
| 62 |
|
| 63 |
|
| 64 |
if (restType_ & rtDisplacement) { |
| 65 |
Vector3d del = molCom - refCom_; |
| 66 |
|
| 67 |
RealType r = del.length(); |
| 68 |
RealType p = 0.5 * kDisp_ * r * r; |
| 69 |
|
| 70 |
pot_ += p; |
| 71 |
|
| 72 |
restInfo_[rtDisplacement] = std::make_pair(r, p); |
| 73 |
|
| 74 |
for(it = forces_.begin(); it != forces_.end(); ++it) |
| 75 |
(*it) = -kDisp_ * del * scaleFactor_; |
| 76 |
} |
| 77 |
|
| 78 |
for(it = struc.begin(); it != struc.end(); ++it) |
| 79 |
(*it) -= molCom; |
| 80 |
|
| 81 |
// rtDisplacement = 1, so anything higher than that requires orientations: |
| 82 |
if (restType_ > 1) { |
| 83 |
Vector3d tBody(0.0); |
| 84 |
|
| 85 |
Mat3x3d R(0.0); |
| 86 |
|
| 87 |
for (int n = 0; n < struc.size(); n++){ |
| 88 |
|
| 89 |
/* |
| 90 |
* correlation matrix R: |
| 91 |
* R(i,j) = sum(over n): y(n,i) * x(n,j) |
| 92 |
* where x(n) and y(n) are two vector sets |
| 93 |
*/ |
| 94 |
|
| 95 |
R += outProduct(struc[n], ref_[n]); |
| 96 |
} |
| 97 |
|
| 98 |
// SVD class uses dynamic matrices, so we must wrap the correlation |
| 99 |
// matrix before calling SVD and then unwrap the results into Mat3x3d |
| 100 |
// and Vector3d before we use them. |
| 101 |
|
| 102 |
DynamicRectMatrix<RealType> Rtmp(3, 3, 0.0); |
| 103 |
DynamicRectMatrix<RealType> vtmp(3, 3); |
| 104 |
DynamicVector<RealType> stmp(3); |
| 105 |
DynamicRectMatrix<RealType> wtmp(3, 3); |
| 106 |
|
| 107 |
Rtmp.setSubMatrix(0, 0, R); |
| 108 |
|
| 109 |
// Heavy lifting goes here: |
| 110 |
|
| 111 |
JAMA::SVD<RealType> svd(Rtmp); |
| 112 |
|
| 113 |
svd.getU(vtmp); |
| 114 |
svd.getSingularValues(stmp); |
| 115 |
svd.getV(wtmp); |
| 116 |
|
| 117 |
Mat3x3d v; |
| 118 |
Vector3d s; |
| 119 |
Mat3x3d w_tr; |
| 120 |
|
| 121 |
vtmp.getSubMatrix(0, 0, v); |
| 122 |
stmp.getSubVector(0, s); |
| 123 |
wtmp.getSubMatrix(0, 0, w_tr); |
| 124 |
|
| 125 |
bool is_reflection = (v.determinant() * w_tr.determinant()) < 0.0; |
| 126 |
|
| 127 |
if (is_reflection){ |
| 128 |
v(2, 0) = -v(2, 0); |
| 129 |
v(2, 1) = -v(2, 1); |
| 130 |
v(2, 2) = -v(2, 2); |
| 131 |
} |
| 132 |
|
| 133 |
RotMat3x3d Atrans = v * w_tr.transpose(); |
| 134 |
RotMat3x3d A = Atrans.transpose(); |
| 135 |
|
| 136 |
Vector3d eularAngles = A.toEulerAngles(); |
| 137 |
|
| 138 |
|
| 139 |
RealType twistAngle, swingAngle; |
| 140 |
Vector3d swingAxis; |
| 141 |
|
| 142 |
Quat4d quat = A.toQuaternion(); |
| 143 |
|
| 144 |
quat.getTwistSwingAxisAngle(twistAngle, swingAngle, swingAxis); |
| 145 |
|
| 146 |
RealType tw, sx, sy, ttw, swingX, swingY; |
| 147 |
quat.toTwistSwing(tw, sx, sy); |
| 148 |
quat.toSwingTwist(swingX, swingY, ttw); |
| 149 |
|
| 150 |
// std::cerr << eularAngles << "\t[" << twistAngle << "," << swingAngle << |
| 151 |
// "]\t[" << tw << "," << sx << "," << sy << "]\t[" << ttw << |
| 152 |
// "," << ssx << "," << ssy << "]" << std::endl; |
| 153 |
|
| 154 |
RealType dVdtwist, dVdswing, dVdswingX, dVdswingY; |
| 155 |
RealType dTwist, dSwing, dSwingX, dSwingY; |
| 156 |
RealType p; |
| 157 |
|
| 158 |
if (restType_ & rtTwist){ |
| 159 |
dTwist = twistAngle - twist0_; |
| 160 |
dVdtwist = kTwist_ * sin(dTwist) ; |
| 161 |
p = kTwist_ * (1.0 - cos(dTwist) ) ; |
| 162 |
pot_ += p; |
| 163 |
tBody -= dVdtwist * V3Z; |
| 164 |
restInfo_[rtTwist] = std::make_pair(twistAngle, p); |
| 165 |
} |
| 166 |
|
| 167 |
// if (restType_ & rtSwing){ |
| 168 |
// dSwing = swingAngle - swing0_; |
| 169 |
// dVdswing = kSwing_ * 2.0 * sin(2.0 * dSwing); |
| 170 |
// p = kSwing_ * (1.0 - cos(2.0 * dSwing)); |
| 171 |
// pot_ += p; |
| 172 |
// tBody -= dVdswing * swingAxis; |
| 173 |
// restInfo_[rtSwing] = std::make_pair(swingAngle, p); |
| 174 |
// } |
| 175 |
|
| 176 |
if (restType_ & rtSwingX){ |
| 177 |
dSwingX = swingX - swingX0_; |
| 178 |
dVdswingX = kSwingX_ * 2.0 * sin(2.0 * dSwingX); |
| 179 |
p = kSwingX_ * (1.0 - cos(2.0 * dSwingX)); |
| 180 |
pot_ += p; |
| 181 |
tBody -= dVdswingX * V3X; |
| 182 |
restInfo_[rtSwingX] = std::make_pair(swingX, p); |
| 183 |
} |
| 184 |
if (restType_ & rtSwingY){ |
| 185 |
dSwingY = swingY - swingY0_; |
| 186 |
dVdswingY = kSwingY_ * 2.0 * sin(2.0 * dSwingY); |
| 187 |
p = kSwingY_ * (1.0 - cos(2.0 * dSwingY)); |
| 188 |
pot_ += p; |
| 189 |
tBody -= dVdswingY * V3Y; |
| 190 |
restInfo_[rtSwingY] = std::make_pair(swingY, p); |
| 191 |
} |
| 192 |
|
| 193 |
|
| 194 |
RealType t2 = dot(tBody, tBody); |
| 195 |
|
| 196 |
Vector3d rLab, rBody, txr, fBody, fLab; |
| 197 |
|
| 198 |
for (int i = 0; i < struc.size(); i++) { |
| 199 |
|
| 200 |
rLab = struc[i]; |
| 201 |
rBody = A * rLab; |
| 202 |
|
| 203 |
txr = cross(tBody, rBody); |
| 204 |
fBody = txr * t2; |
| 205 |
fLab = Atrans * fBody; |
| 206 |
fLab *= scaleFactor_; |
| 207 |
|
| 208 |
forces_[i] += fLab; |
| 209 |
} |
| 210 |
|
| 211 |
// test the force vectors and see if it is the right orientation |
| 212 |
// std::cout << struc.size() << std::endl << std::endl; |
| 213 |
// for (int i = 0; i != struc.size(); ++i){ |
| 214 |
// std::cout << "H\t" << struc[i].x() << "\t" << struc[i].y() << "\t" << struc[i].z() << "\t"; |
| 215 |
// std::cout << forces_[i].x() << "\t" << forces_[i].y() << "\t" << forces_[i].z() << std::endl; |
| 216 |
// } |
| 217 |
} |
| 218 |
} |
| 219 |
} |
