7 double ca,
sa, cb, sb, cg, sg;
16 this->
el(0, 0) = ca * cb * cg - sa * sg;
17 this->
el(0, 1) = cb * cg * sa + ca * sg;
18 this->
el(0, 2) = -cg * sb;
20 this->
el(1, 0) = -sg * cb * ca - cg *
sa;
21 this->
el(1, 1) = -sg * cb * sa + cg * ca;
22 this->
el(1, 2) = sb * sg;
24 this->
el(2, 0) = ca * sb;
25 this->
el(2, 1) = sa * sb;
35 this->
set(alpha, beta, gamma);
65 for (
int row = 1; row < 4; ++row)
66 for (
int col = 1; col < 4; ++col) {
68 this->
el(row, col) = (
const_cast<rotation*
>(&r))->el(row - 1, col - 1);
88 this->
set(alpha,
beta, gamma);
108 gFactor = pow(gamma, 2) / (gamma + 1);
110 this->
el(0, 0) = gamma;
111 this->
el(0, 1) = gamma * beta.
x();
112 this->
el(0, 2) = gamma * beta.
y();
113 this->
el(0, 3) = gamma * beta.
z();
115 this->
el(1, 1) = (pow(beta.
x(), 2) * gFactor) + 1;
116 this->
el(1, 2) = beta.
x() * beta.
y() * gFactor;
117 this->
el(1, 3) = beta.
x() * beta.
z() * gFactor;
119 this->
el(2, 2) = (pow(beta.
y(), 2) * gFactor) + 1;
120 this->
el(2, 3) = beta.
y() * beta.
z() * gFactor;
122 this->
el(3, 3) = (pow(beta.
z(), 2) * gFactor) + 1;
124 this->
el(1, 0) = this->
el(0, 1);
125 this->
el(2, 0) = this->
el(0, 2);
126 this->
el(2, 1) = this->
el(1, 2);
127 this->
el(3, 0) = this->
el(0, 3);
128 this->
el(3, 1) = this->
el(1, 3);
129 this->
el(3, 2) = this->
el(2, 3);
147 beta.
el(0) = -p.
x() / p.
t();
148 beta.
el(1) = -p.
y() / p.
t();
149 beta.
el(2) = -p.
z() / p.
t();