| James Kuszmaul | 18008f8 | 2023-02-23 20:52:50 -0800 | [diff] [blame^] | 1 | #ifndef Y2023_LOCALIZER_UTILS_H_ |
| 2 | #define Y2023_LOCALIZER_UTILS_H_ | ||||
| 3 | |||||
| 4 | #include <Eigen/Dense> | ||||
| 5 | |||||
| 6 | #include "frc971/vision/target_map_generated.h" | ||||
| 7 | |||||
| 8 | namespace y2023::localizer { | ||||
| 9 | // Converts a TargetPoseFbs into a transformation matrix. | ||||
| 10 | Eigen::Matrix<double, 4, 4> PoseToTransform( | ||||
| 11 | const frc971::vision::TargetPoseFbs *pose); | ||||
| 12 | } // namespace y2023::localizer | ||||
| 13 | |||||
| 14 | #endif // Y2023_LOCALIZER_UTILS_H_ | ||||