| 469 | } |
| 470 | |
| 471 | Eigen::Vector3d |
| 472 | PulseCollection::Trajectory(double t, Eigen::Vector3d& v, Eigen::Vector3d& a) const |
| 473 | { |
| 474 | return traj.position(t - m_timeOrigin, v, a) + m_rOrigin; |
| 475 | } |
| 476 | |
| 477 | Eigen::Vector2d PulseCollection::Attitude(double t, Eigen::Vector2d& v) const |
| 478 | { |