42 |
|
#include <math.h> |
43 |
|
#include "primitives/RigidBody.hpp" |
44 |
|
#include "utils/simError.h" |
45 |
+ |
#include "utils/NumericConstant.hpp" |
46 |
|
namespace oopse { |
47 |
|
|
48 |
|
RigidBody::RigidBody() : StuntDouble(otRigidBody, &Snapshot::rigidbodyData), inertiaTensor_(0.0){ |
292 |
|
|
293 |
|
for (i = 0; i < atoms_.size(); i++) { |
294 |
|
|
295 |
< |
ref = body2Lab(refCoords_[i]); |
295 |
> |
ref = body2Lab(refCoords_[i], frame); |
296 |
|
|
297 |
|
apos = pos + ref; |
298 |
|
|
511 |
|
simError(); |
512 |
|
} |
513 |
|
|
514 |
< |
euler[0] = ats->getEulerPhi(); |
515 |
< |
euler[1] = ats->getEulerTheta(); |
516 |
< |
euler[2] = ats->getEulerPsi(); |
514 |
> |
euler[0] = ats->getEulerPhi() * NumericConstant::PI /180.0; |
515 |
> |
euler[1] = ats->getEulerTheta() * NumericConstant::PI /180.0; |
516 |
> |
euler[2] = ats->getEulerPsi() * NumericConstant::PI /180.0; |
517 |
|
|
518 |
|
RotMat3x3d Atmp(euler); |
519 |
|
refOrients_.push_back(Atmp); |