| 71 | } |
| 72 | |
| 73 | Eigen::Vector3d |
| 74 | DetectionSource::transform(const Eigen::Vector3d& v) |
| 75 | { |
| 76 | Eigen::Vector3d ret; |
| 77 | tf::Vector3 t(v(0), v(1), v(2)); |
| 78 | t = transform_(t); |
| 79 | ret(0) = t.getX(); |
| 80 | ret(1) = t.getY(); |
| 81 | ret(2) = t.getZ(); |
| 82 | return ret; |
| 83 | } |
| 84 | |
| 85 | Eigen::Vector3d |
| 86 | DetectionSource::transform(const geometry_msgs::Vector3& v) |
no outgoing calls
no test coverage detected