| 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 |
|
|
| 179 |
|
} |
| 180 |
|
} |
| 181 |
|
|
| 182 |
< |
std::cout << Itmp << std::endl; |
| 182 |
> |
// std::cout << Itmp << std::endl; |
| 183 |
|
|
| 184 |
|
//diagonalize |
| 185 |
|
Vector3d evals; |
| 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 |
|
} |