Functions to cast the ZED SDK sl::Matrix4f to Eigen::Matrix4f

castMatEigenSL.cpp

void Transform2Matrix4f(const sl::Matrix4f &array_, Eigen::Matrix4f &mat_) {
    for(int y = 0; y < 4; y++) {
        for(int x = 0; x < 4; x++)
            mat_(y, x) = array_.m[y * 4 + x];
    }
}

void Matrix4f2Transform(const Eigen::Matrix4f &mat_, sl::Matrix4f &array_) {
    for(int y = 0; y < 4; y++) {
        for(int x = 0; x < 4; x++)
            array_.m[y * 4 + x] = mat_(y, x);
    }
}