| 386 | #pragma warning (pop) |
| 387 | |
| 388 | Eigen::Vector3d rotate(const Eigen::Vector3d& v, const Eigen::Quaterniond& rot) |
| 389 | { |
| 390 | Eigen::Quaterniond p; |
| 391 | p.w() = 0; |
| 392 | p.vec() = v; |
| 393 | p = rot * p * rot.inverse(); |
| 394 | return p.vec(); |
| 395 | } |
| 396 | |
| 397 | namespace |
| 398 | { |
no outgoing calls