将tof相机得到的深度图像转换为灰度图像,然后对灰度图像进行双边滤波,去除噪声的同时使边缘得到较好的保持,然后对滤波后的灰度图像进行hough圆变换,得到圆心在图像中的像素坐标,然后利用tof相机的点云数据,求得圆心在tof相机坐标系下的三维坐标。
程序如下:
#include "opencv2/core/core.hpp"
#include "opencv2/highgui/highgui.hpp"
#include "opencv2/imgproc/imgproc.hpp"
#include "opencv2/features2d/features2d.hpp" //需要添加该头文件
#include <iostream>
#include "Math.h"
using namespace cv;
using namespace std;
int main(int argc, char**argv)
{
Mat src, gray, edge, erzhitu, bifilter;
//读入图像
src = imread("D:\\yanxiaopan\\my project\\2017.2.22\\X\\250\\f.jpg");
if (!src.data)
return -