43 |
|
|
44 |
|
namespace oopse { |
45 |
|
|
46 |
< |
void DLM::doRotate(StuntDouble* sd, Vector3d& ji, double dt) { |
47 |
< |
double dt2 = 0.5 * dt; |
48 |
< |
double angle; |
46 |
> |
void DLM::doRotate(StuntDouble* sd, Vector3d& ji, RealType dt) { |
47 |
> |
RealType dt2 = 0.5 * dt; |
48 |
> |
RealType angle; |
49 |
|
|
50 |
|
RotMat3x3d A = sd->getA(); |
51 |
|
Mat3x3d I = sd->getI(); |
94 |
|
} |
95 |
|
|
96 |
|
|
97 |
< |
void DLM::rotateStep(int axes1, int axes2, double angle, Vector3d& ji, RotMat3x3d& A) { |
97 |
> |
void DLM::rotateStep(int axes1, int axes2, RealType angle, Vector3d& ji, RotMat3x3d& A) { |
98 |
|
|
99 |
< |
double sinAngle; |
100 |
< |
double cosAngle; |
101 |
< |
double angleSqr; |
102 |
< |
double angleSqrOver4; |
103 |
< |
double top, bottom; |
99 |
> |
RealType sinAngle; |
100 |
> |
RealType cosAngle; |
101 |
> |
RealType angleSqr; |
102 |
> |
RealType angleSqrOver4; |
103 |
> |
RealType top, bottom; |
104 |
|
|
105 |
|
RotMat3x3d tempA(A); // initialize the tempA |
106 |
|
Vector3d tempJ(0.0); |