| 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); |