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_ |