| 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 |
|
|
| 175 |
|
|
| 176 |
|
//project the inertial moment of directional atoms into this rigid body |
| 177 |
|
if (atoms_[i]->isDirectional()) { |
| 180 |
– |
Itmp += IAtom; |
| 178 |
|
Itmp += refOrients_[i].transpose() * atoms_[i]->getI() * refOrients_[i]; |
| 179 |
|
} |
| 180 |
|
} |
| 181 |
|
|
| 182 |
+ |
// std::cout << Itmp << std::endl; |
| 183 |
+ |
|
| 184 |
|
//diagonalize |
| 185 |
|
Vector3d evals; |
| 186 |
|
Mat3x3d::diagonalize(Itmp, evals, sU_); |
| 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 |
|
} |