186 |
|
//z-axis (again). |
187 |
|
|
188 |
|
Euler3 e; |
189 |
– |
Mat3x3d m; |
189 |
|
double cosTheta; |
190 |
|
double sinTheta; |
191 |
|
const double eps = 1.0e-8; |
225 |
|
|
226 |
|
return e; |
227 |
|
} |
228 |
+ |
|
229 |
+ |
|
230 |
+ |
Vector3d operator*(const Mat3x3d& m, const Vector3d& v){ |
231 |
+ |
Vector3d result; |
232 |
+ |
|
233 |
+ |
result.x = m.element[0][0] * v.x + m.element[0][1] * v.y + m.element[0][2]*v.z; |
234 |
+ |
result.x = m.element[1][0] * v.x + m.element[1][1] * v.y + m.element[1][2]*v.z; |
235 |
+ |
result.x = m.element[2][0] * v.x + m.element[2][1] * v.y + m.element[2][2]*v.z; |
236 |
+ |
|
237 |
+ |
return result; |
238 |
+ |
} |