1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101
|
//
// Copyright (C) 2024-2025 Greg Landrum and other RDKit contributors
//
// @@ All Rights Reserved @@
// This file is part of the RDKit.
// The contents are covered by the terms of the BSD license
// which is included in the file license.txt, found at the root
// of the RDKit source tree.
//
#include "DistViolationContribs.h"
#include <ForceField/ForceField.h>
#include <RDGeneral/Invariant.h>
namespace DistGeom {
DistViolationContribs::DistViolationContribs(ForceFields::ForceField *owner) {
PRECONDITION(owner, "bad owner");
dp_forceField = owner;
}
inline double distance2(const unsigned int idx1, const unsigned int idx2,
const double *pos, const unsigned int dim) {
const auto *end1Coords = &(pos[dim * idx1]);
const auto *end2Coords = &(pos[dim * idx2]);
double d2 = 0.0;
for (unsigned int i = 0; i < dim; i++) {
double d = end1Coords[i] - end2Coords[i];
d2 += d * d;
}
return d2;
}
inline double distance(const unsigned int idx1, const unsigned int idx2,
const double *pos, const unsigned int dim) {
return sqrt(distance2(idx1, idx2, pos, dim));
}
double DistViolationContribs::getEnergy(double *pos) const {
PRECONDITION(dp_forceField, "no owner");
PRECONDITION(pos, "bad vector");
double accum = 0.0;
auto contrib = [&](const auto &c) {
double d2 = distance2(c.idx1, c.idx2, pos, dp_forceField->dimension());
double val = 0.0;
if (d2 > c.ub2) {
val = (d2 / (c.ub2)) - 1.0;
} else if (d2 < c.lb2) {
val = ((2 * c.lb2) / (c.lb2 + d2)) - 1.0;
}
if (val > 0.0) {
accum += c.weight * val * val;
}
};
for (const auto &c : d_contribs) {
contrib(c);
}
return accum;
}
void DistViolationContribs::getGrad(double *pos, double *grad) const {
PRECONDITION(dp_forceField, "no owner");
PRECONDITION(pos, "bad vector");
PRECONDITION(grad, "bad vector");
const unsigned int dim = this->dp_forceField->dimension();
auto contrib = [&](const auto &c) {
double d2 = distance2(c.idx1, c.idx2, pos, dp_forceField->dimension());
double d;
double preFactor = 0.0;
if (d2 > c.ub2) {
d = sqrt(d2);
preFactor = 4. * (((d * d) / c.ub2) - 1.0) * (d / c.ub2);
} else if (d2 < c.lb2) {
d = sqrt(d2);
double l2d2 = d2 + c.lb2;
preFactor = 8. * c.lb2 * d * (1. - 2 * c.lb2 / l2d2) / (l2d2 * l2d2);
} else {
return;
}
for (unsigned int i = 0; i < dim; i++) {
const auto p1 = dim * c.idx1 + i;
const auto p2 = dim * c.idx2 + i;
double dGrad;
if (d > 0.0) {
dGrad = c.weight * preFactor * (pos[p1] - pos[p2]) / d;
} else {
// FIX: this likely isn't right
dGrad = c.weight * preFactor * (pos[p1] - pos[p2]);
}
grad[p1] += dGrad;
grad[p2] -= dGrad;
}
};
for (const auto &c : d_contribs) {
contrib(c);
}
}
} // namespace DistGeom
|