| 261 | } |
| 262 | |
| 263 | Eigen::Matrix4f ConfigUtils::LoadMatrix4f(const cv::FileNode& node) { |
| 264 | Eigen::Matrix4f matrix = Eigen::Matrix4f::Identity(); |
| 265 | |
| 266 | if (node.isSeq() && node.size() == 4) { |
| 267 | for (int i = 0; i < 4; ++i) { |
| 268 | cv::FileNode row = node[i]; |
| 269 | if (row.isSeq() && row.size() == 4) { |
| 270 | for (int j = 0; j < 4; ++j) { |
| 271 | matrix(i, j) = (float)(double)row[j]; |
| 272 | } |
| 273 | } |
| 274 | } |
| 275 | } |
| 276 | |
| 277 | return matrix; |
| 278 | } |
| 279 | |
| 280 | } // namespace vio_360 |
nothing calls this directly
no outgoing calls
no test coverage detected