mirror of
https://github.com/opencv/opencv.git
synced 2024-12-11 22:59:16 +08:00
dfc61fbfaa
Add support for Orbbec Gemini2 and Gemini2 XL camera #24666 ### Pull Request Readiness Checklist See details at https://github.com/opencv/opencv/wiki/How_to_contribute#making-a-good-pull-request - [x] I agree to contribute to the project under Apache 2 License. - [x] To the best of my knowledge, the proposed patch is not based on a code under GPL or another license that is incompatible with OpenCV - [x] The PR is proposed to the proper branch
84 lines
3.1 KiB
C++
84 lines
3.1 KiB
C++
/**
|
|
* attention: Astra2, Gemini2, and Gemini2L cameras currently only support Windows and Linux kernel versions no higher than 4.15, and higher versions of Linux kernel may have exceptions.
|
|
*/
|
|
|
|
#include <opencv2/videoio.hpp>
|
|
#include <opencv2/highgui.hpp>
|
|
#include <opencv2/imgproc.hpp>
|
|
#include <iostream>
|
|
|
|
using namespace cv;
|
|
int main()
|
|
{
|
|
VideoCapture obsensorCapture(0, CAP_OBSENSOR);
|
|
if(!obsensorCapture.isOpened()){
|
|
std::cerr << "Failed to open obsensor capture! Index out of range or no response from device";
|
|
return -1;
|
|
}
|
|
|
|
double fx = obsensorCapture.get(CAP_PROP_OBSENSOR_INTRINSIC_FX);
|
|
double fy = obsensorCapture.get(CAP_PROP_OBSENSOR_INTRINSIC_FY);
|
|
double cx = obsensorCapture.get(CAP_PROP_OBSENSOR_INTRINSIC_CX);
|
|
double cy = obsensorCapture.get(CAP_PROP_OBSENSOR_INTRINSIC_CY);
|
|
std::cout << "obsensor camera intrinsic params: fx=" << fx << ", fy=" << fy << ", cx=" << cx << ", cy=" << cy << std::endl;
|
|
|
|
Mat image;
|
|
Mat depthMap;
|
|
Mat adjDepthMap;
|
|
|
|
// Minimum depth value
|
|
const double minVal = 300;
|
|
// Maximum depth value
|
|
const double maxVal = 5000;
|
|
while (true)
|
|
{
|
|
// Grab depth map like this:
|
|
// obsensorCapture >> depthMap;
|
|
|
|
// Another way to grab depth map (and bgr image).
|
|
if (obsensorCapture.grab())
|
|
{
|
|
if (obsensorCapture.retrieve(image, CAP_OBSENSOR_BGR_IMAGE))
|
|
{
|
|
imshow("RGB", image);
|
|
}
|
|
|
|
if (obsensorCapture.retrieve(depthMap, CAP_OBSENSOR_DEPTH_MAP))
|
|
{
|
|
depthMap.convertTo(adjDepthMap, CV_8U, 255.0 / (maxVal - minVal), -minVal * 255.0 / (maxVal - minVal));
|
|
applyColorMap(adjDepthMap, adjDepthMap, COLORMAP_JET);
|
|
imshow("DEPTH", adjDepthMap);
|
|
}
|
|
|
|
// depth map overlay on bgr image
|
|
static const float alpha = 0.6f;
|
|
if (!image.empty() && !depthMap.empty())
|
|
{
|
|
depthMap.convertTo(adjDepthMap, CV_8U, 255.0 / (maxVal - minVal), -minVal * 255.0 / (maxVal - minVal));
|
|
cv::resize(adjDepthMap, adjDepthMap, cv::Size(image.cols, image.rows));
|
|
for (int i = 0; i < image.rows; i++)
|
|
{
|
|
for (int j = 0; j < image.cols; j++)
|
|
{
|
|
cv::Vec3b& outRgb = image.at<cv::Vec3b>(i, j);
|
|
uint8_t depthValue = 255 - adjDepthMap.at<uint8_t>(i, j);
|
|
if (depthValue != 0 && depthValue != 255)
|
|
{
|
|
outRgb[0] = (uint8_t)(outRgb[0] * (1.0f - alpha) + depthValue * alpha);
|
|
outRgb[1] = (uint8_t)(outRgb[1] * (1.0f - alpha) + depthValue * alpha);
|
|
outRgb[2] = (uint8_t)(outRgb[2] * (1.0f - alpha) + depthValue * alpha);
|
|
}
|
|
}
|
|
}
|
|
imshow("DepthToColor", image);
|
|
}
|
|
image.release();
|
|
depthMap.release();
|
|
}
|
|
|
|
if (pollKey() >= 0)
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|