| 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 |
+ |
} |