diff --git a/components/rgbd-sources/src/sources/stereovideo/stereovideo.cpp b/components/rgbd-sources/src/sources/stereovideo/stereovideo.cpp index ccb3cada41924f3ab9fd0e0c12ba62aa48d02375..3a0587ebb989ae8439212d3632e23333518a79c6 100644 --- a/components/rgbd-sources/src/sources/stereovideo/stereovideo.cpp +++ b/components/rgbd-sources/src/sources/stereovideo/stereovideo.cpp @@ -199,7 +199,7 @@ void StereoVideoSource::updateParameters() { cv::Mat K; // same for left and right - double baseline = calib_->getQ().at<double>(3,2); + double baseline = 1.0 / calib_->getQ().at<double>(3,2); double doff = -calib_->getQ().at<double>(3,3) * baseline; // left @@ -214,7 +214,7 @@ void StereoVideoSource::updateParameters() { (unsigned int) color_size_.height, 0.0f, // 0m min 15.0f, // 15m max - 1.0 / baseline, // Baseline + baseline, // Baseline doff }; @@ -236,7 +236,7 @@ void StereoVideoSource::updateParameters() { (unsigned int) color_size_.height, 0.0f, // 0m min 15.0f, // 15m max - 1.0 / baseline, // Baseline + baseline, // Baseline doff }; } diff --git a/components/streams/src/parsers.cpp b/components/streams/src/parsers.cpp index ebca4576bfb14f4919aaea5ad4376e0bd5a667a6..f6dee9cce2ef2981dfadc7dbd5bf5567c5ef44b6 100644 --- a/components/streams/src/parsers.cpp +++ b/components/streams/src/parsers.cpp @@ -10,7 +10,11 @@ ftl::rgbd::Camera ftl::stream::parseCalibration(const ftl::codecs::Packet &pkt) auto unpacked = msgpack::unpack((const char*)pkt.data.data(), pkt.data.size()); unpacked.get().convert(params); - LOG(INFO) << "Got Calibration: " << std::get<0>(params).width << "x" << std::get<0>(params).height; + LOG(INFO) << "Got Calibration: " + << std::get<0>(params).width << "x" << std::get<0>(params).height + << ", fx: " << std::get<0>(params).fx + << ", cx: " << std::get<0>(params).cx + << ", cy: " << std::get<0>(params).cy; return std::get<0>(params); }