| 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 | 
  | 
 | 
| 171 | 
  | 
      IAtom(0, 0) += mtmp * r2; | 
| 172 | 
  | 
      IAtom(1, 1) += mtmp * r2; | 
| 173 | 
  | 
      IAtom(2, 2) += mtmp * r2; | 
| 174 | 
+ | 
      Itmp += IAtom; | 
| 175 | 
  | 
 | 
| 176 | 
  | 
      //project the inertial moment of directional atoms into this rigid body | 
| 177 | 
  | 
      if (atoms_[i]->isDirectional()) { | 
| 178 | 
< | 
        IAtom += atoms_[i]->getI(); | 
| 179 | 
< | 
        Itmp += refOrients_[i].transpose() * IAtom * refOrients_[i]; | 
| 181 | 
< | 
      } else { | 
| 182 | 
< | 
        Itmp += IAtom; | 
| 183 | 
< | 
      } | 
| 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 | 
  | 
      }     |