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 |
|
} |
481 |
|
"RigidBody error.\n" |
482 |
|
"\tAtom %s does not have a position specified.\n" |
483 |
|
"\tThis means RigidBody cannot set up reference coordinates.\n", |
484 |
< |
ats->getType() ); |
484 |
> |
ats->getType().c_str() ); |
485 |
|
painCave.isFatal = 1; |
486 |
|
simError(); |
487 |
|
} |
501 |
|
"RigidBody error.\n" |
502 |
|
"\tAtom %s does not have an orientation specified.\n" |
503 |
|
"\tThis means RigidBody cannot set up reference orientations.\n", |
504 |
< |
ats->getType() ); |
504 |
> |
ats->getType().c_str() ); |
505 |
|
painCave.isFatal = 1; |
506 |
|
simError(); |
507 |
|
} |