| 51 |
|
|
| 52 |
|
void RigidBody::setPrevA(const RotMat3x3d& a) { |
| 53 |
|
((snapshotMan_->getPrevSnapshot())->*storage_).aMat[localIndex_] = a; |
| 54 |
– |
//((snapshotMan_->getPrevSnapshot())->*storage_).electroFrame[localIndex_] = a.transpose() * sU_; |
| 54 |
|
|
| 55 |
|
for (int i =0 ; i < atoms_.size(); ++i){ |
| 56 |
|
if (atoms_[i]->isDirectional()) { |
| 57 |
< |
atoms_[i]->setPrevA(a * refOrients_[i]); |
| 57 |
> |
atoms_[i]->setPrevA(refOrients_[i].transpose() * a); |
| 58 |
|
} |
| 59 |
|
} |
| 60 |
|
|
| 63 |
|
|
| 64 |
|
void RigidBody::setA(const RotMat3x3d& a) { |
| 65 |
|
((snapshotMan_->getCurrentSnapshot())->*storage_).aMat[localIndex_] = a; |
| 67 |
– |
//((snapshotMan_->getCurrentSnapshot())->*storage_).electroFrame[localIndex_] = a.transpose() * sU_; |
| 66 |
|
|
| 67 |
|
for (int i =0 ; i < atoms_.size(); ++i){ |
| 68 |
|
if (atoms_[i]->isDirectional()) { |
| 69 |
< |
atoms_[i]->setA(a * refOrients_[i]); |
| 69 |
> |
atoms_[i]->setA(refOrients_[i].transpose() * a); |
| 70 |
|
} |
| 71 |
|
} |
| 72 |
|
} |
| 77 |
|
|
| 78 |
|
for (int i =0 ; i < atoms_.size(); ++i){ |
| 79 |
|
if (atoms_[i]->isDirectional()) { |
| 80 |
< |
atoms_[i]->setA(a * refOrients_[i], snapshotNo); |
| 80 |
> |
atoms_[i]->setA(refOrients_[i].transpose() * a, snapshotNo); |
| 81 |
|
} |
| 82 |
|
} |
| 83 |
|
|
| 245 |
|
|
| 246 |
|
} |
| 247 |
|
|
| 248 |
< |
setFrc(frc); |
| 249 |
< |
setTrq(trq); |
| 248 |
> |
addFrc(frc); |
| 249 |
> |
addTrq(trq); |
| 250 |
|
|
| 251 |
|
} |
| 252 |
|
|
| 269 |
|
if (atoms_[i]->isDirectional()) { |
| 270 |
|
|
| 271 |
|
dAtom = (DirectionalAtom *) atoms_[i]; |
| 272 |
< |
dAtom->setA(refOrients_[i] * a); |
| 272 |
> |
dAtom->setA(refOrients_[i].transpose() * a); |
| 273 |
|
} |
| 274 |
|
|
| 275 |
|
} |
| 296 |
|
if (atoms_[i]->isDirectional()) { |
| 297 |
|
|
| 298 |
|
dAtom = (DirectionalAtom *) atoms_[i]; |
| 299 |
< |
dAtom->setA(refOrients_[i] * a, frame); |
| 299 |
> |
dAtom->setA(refOrients_[i].transpose() * a, frame); |
| 300 |
|
} |
| 301 |
|
|
| 302 |
|
} |