fix(rectify_processor.cc): fix loadT() bug

This commit is contained in:
Messier 2019-09-03 14:53:14 +08:00
parent f903bfd609
commit 08b3ccb401

View File

@ -229,7 +229,7 @@ void RectifyProcessor::stereoRectify(models::CameraPtr leftOdo,
// Eigen::Matrix4d RectifyProcessor::loadT(const mynteye::Extrinsics& in) { // Eigen::Matrix4d RectifyProcessor::loadT(const mynteye::Extrinsics& in) {
// subEigen // subEigen
Ctain::Matrix4d RectifyProcessor::loadT(const mynteye::Extrinsics &in) { Ctain::Matrix4d RectifyProcessor::loadT(const mynteye::Extrinsics &in) {
Ctain::Matrix3d R; Ctain::Matrix3d R(3);
R<< R<<
in.rotation[0][0] << in.rotation[0][1] << in.rotation[0][2] << in.rotation[0][0] << in.rotation[0][1] << in.rotation[0][2] <<
in.rotation[1][0] << in.rotation[1][1] << in.rotation[1][2] << in.rotation[1][0] << in.rotation[1][1] << in.rotation[1][2] <<