Open DMUZhangXianglong opened 1 month ago
Eigen::Matrix<double, 3, 6> J; // 组装雅可比 J.block<3, 3>(0, 0) = pose.so3().matrix() * SO3::hat(q); J.block<3, 3>(0, 3) = -Mat3d::Identity();
为什么 pose.so3().matrix() * SO3::hat(q); 前面没有负号
Eigen::Matrix<double, 3, 6> J; // 组装雅可比 J.block<3, 3>(0, 0) = pose.so3().matrix() * SO3::hat(q); J.block<3, 3>(0, 3) = -Mat3d::Identity();
为什么 pose.so3().matrix() * SO3::hat(q); 前面没有负号