eigen3 - 在谷神星的双阵列的一部分上进行 AngleAxisToRotationMatirx？

Question

现在我正在与 Ceres 和 Eigen 合作。我有一个6x3 = 18 -d 双数组，我们称之为xs，它定义为：

double xs[6*3];

基本上xs包含以角度轴格式表示的 6 个旋转。并且我需要将所有 6 的每个旋转转换为旋转矩阵格式，然后进行矩阵乘法。

struct F1 {
    template <typename T> bool operator()(const T* const xs,
                                    T* residual) const {
    Eigen::Map<const Eigen::Matrix<T,3,1> > m0(xs, 3);

    T m[9], res[3];
    ceres::AngleAxisToRotationMatrix(m0, m);


    residual[0] = res[0];
    residual[1] = res[1];
    residual[2] = res[2];
}

在示例代码中，我通过Eigen::Map提取xs的前 3 个元素，然后在其上应用AngleAxisToRotationMatrix。但我不断收到这样的错误：

error: no matching function for call to ‘AngleAxisToRotationMatrix(Eigen::Map<const Eigen::Matrix<ceres::Jet<double, 18>, 3, 1, 0, 3, 1>, 0, Eigen::Stride<0, 0> >&, ceres::Jet<double, 1> [9])’

有人可以在这里帮帮我吗？我对 Ceres 和 Eigen 还很陌生，这真的把我逼疯了。

谢谢！

Answer 1

ceres::AngleAxisToRotationMatrix期望原始指针：

AngleAxisToRotationMatrix(xs, m);