一种基于圆形的特殊标记识别

由于项目需要,我之前做了一个基于圆形图案的标记识别,其目的是实现单目相机对标记物的识别和定位。标记如下所示:


这个东西有四个圆形组成,打印出来后,测量其尺寸,就可以通过识别其图像位置,再使用P4P解算,就可以得到该平面相对于相机的三维方向和倾角。


首先是识别:

		ima = ardrone.getImage();
	SimpleBlobDetector::Params params;
	params.minThreshold = 40;
	params.maxThreshold = 160;
	params.thresholdStep = 5;
	params.minArea = 100;
	params.minConvexity = 0.7f;
	params.minInertiaRatio = 0.8f;
	params.maxArea = 8000;

	params.filterByCircularity = true;
	params.minCircularity = 0.5;
	params.maxCircularity = 1.5;
	params.maxInertiaRatio = 1;
	params.maxConvexity = 1;

	cv::Ptr<cv::SimpleBlobDetector> detector = cv::SimpleBlobDetector::create(params);
	cvtColor(ima, gray, CV_BGR2GRAY); // smooth it, otherwise a lot of false circles may be detected 
		//normalize(gray, gray, 0, 255, 32);
		//cout << gray.rows <<' '<<gray.cols<< endl;
		std::vector<KeyPoint> keypoints;
if (keypoints.size() != pointnum)continue;

		int fail = 0;
		for (int i = 1; i < pointnum; i++)
		{
			if (abs(keypoints[0].size - keypoints[i].size) / keypoints[0].size > 0.3)fail = 1;
		}
		if (fail == 1)continue;
		vector<vector<int>>dis;
		for (int i = 0; i < pointnum; i++)
		{
			vector<int> temp;
			for (int j = 0; j < pointnum; j++)
			{
				if (j == i)continue;
				temp.push_back(GetDis(keypoints[i].pt, keypoints[j].pt));
			}
			dis.push_back(temp);
		}
		int pa = -1, pb = -1, pc = -1, pd = -1;
		for (int i = 0; i < pointnum; i++)
		{
			int a = dis[i][0] - dis[i][1];
			int b = dis[i][2] - dis[i][1];
			int c = dis[i][0] - dis[i][2];
			if ((float)abs(a) / (float)dis[i][0] < 0.2 && (float)abs(c) / (float)dis[i][0] < 0.2)
				pa = i;
			else if ((float)abs(a) / (float)dis[i][0] <0.2 && (float)abs(c) / (float)dis[i][0] >0.5&&c<0)
				pb = i;
			else if ((float)abs(c) / (float)dis[i][0] <0.2 && (float)abs(a) / (float)dis[i][0] >0.5&&a<0)
				pb = i;
			else if ((float)abs(c) / (float)dis[i][0] > 0.5 && (float)abs(a) / (float)dis[i][0] > 0.5 && (float)abs(a) / (float)dis[i][1] < 0.2)
				pb = i;
			else if ((float)dis[i][1] / (float)dis[i][0] <0.8 && (float)dis[i][2] / (float)dis[i][0] <0.8 && (float)abs(b) / (float)dis[i][1] <0.2)
				pb = i;
		}
		if (pa < 0 || pb < 0)continue;
		drawArrow(ima, keypoints[pa].pt, keypoints[pb].pt, 10, 60, Scalar(0, 0, 255));
		putText(ima, "0", keypoints[pa].pt, 0, 1.0f, CV_RGB(255, 0, 0), 2);
		putText(ima, "1", keypoints[pb].pt, 0, 1.0f, CV_RGB(255, 0, 0), 2);

detector->detect(gray, keypoints);

这里使用了OPRENCV自带的斑点检测法进行检验,设定参数后,得到比较准确的斑点。

然后对斑点的相对位置进行检验,得到点的相对位置和整个图案的指向方向。

if (keypoints.size() != pointnum)continue;

		int fail = 0;
		for (int i = 1; i < pointnum; i++)
		{
			if (abs(keypoints[0].size - keypoints[i].size) / keypoints[0].size > 0.3)fail = 1;
		}
		if (fail == 1)continue;
		vector<vector<int>>dis;
		for (int i = 0; i < pointnum; i++)
		{
			vector<int> temp;
			for (int j = 0; j < pointnum; j++)
			{
				if (j == i)continue;
				temp.push_back(GetDis(keypoints[i].pt, keypoints[j].pt));
			}
			dis.push_back(temp);
		}
		int pa = -1, pb = -1, pc = -1, pd = -1;
		for (int i = 0; i < pointnum; i++)
		{
			int a = dis[i][0] - dis[i][1];
			int b = dis[i][2] - dis[i][1];
			int c = dis[i][0] - dis[i][2];
			if ((float)abs(a) / (float)dis[i][0] < 0.2 && (float)abs(c) / (float)dis[i][0] < 0.2)
				pa = i;
			else if ((float)abs(a) / (float)dis[i][0] <0.2 && (float)abs(c) / (float)dis[i][0] >0.5&&c<0)
				pb = i;
			else if ((float)abs(c) / (float)dis[i][0] <0.2 && (float)abs(a) / (float)dis[i][0] >0.5&&a<0)
				pb = i;
			else if ((float)abs(c) / (float)dis[i][0] > 0.5 && (float)abs(a) / (float)dis[i][0] > 0.5 && (float)abs(a) / (float)dis[i][1] < 0.2)
				pb = i;
			else if ((float)dis[i][1] / (float)dis[i][0] <0.8 && (float)dis[i][2] / (float)dis[i][0] <0.8 && (float)abs(b) / (float)dis[i][1] <0.2)
				pb = i;
		}
		if (pa < 0 || pb < 0)continue;
		drawArrow(ima, keypoints[pa].pt, keypoints[pb].pt, 10, 60, Scalar(0, 0, 255));
		putText(ima, "0", keypoints[pa].pt, 0, 1.0f, CV_RGB(255, 0, 0), 2);
		putText(ima, "1", keypoints[pb].pt, 0, 1.0f, CV_RGB(255, 0, 0), 2);

然后就是计算距离了,先构造四个点的相机坐标系坐标,然后在图上找到四个点的像素坐标,然后带入solvePnP计算,就可以得到一个平移和旋转矩阵,从平移和旋转矩阵中就可以计算出该平面相对与相机的位置了。代码如下:

	if (DIS)
		{
			for (int i = 0; i < pointnum; i++)
			{
				if (i != pa&&i != pb)
					if (LinePoint(keypoints[pa].pt, keypoints[pb].pt, keypoints[i].pt) > 0)
						pc = i;
					else pd = i;
			}
			if (pc < 0 || pd < 0)continue;
			putText(ima, "2", keypoints[pc].pt, 0, 1.0f, CV_RGB(255, 0, 0), 2);
			putText(ima, "3", keypoints[pd].pt, 0, 1.0f, CV_RGB(255, 0, 0), 2);
			vector<Point2f> centers;
			centers.push_back(keypoints[pa].pt);
			centers.push_back(keypoints[pb].pt);
			centers.push_back(keypoints[pc].pt);
			centers.push_back(keypoints[pd].pt);
			vector<Point2f> tempshape;
			tempshape.push_back(keypoints[pa].pt);
			tempshape.push_back(keypoints[pc].pt);
			tempshape.push_back(keypoints[pb].pt);
			tempshape.push_back(keypoints[pd].pt);
			double matchresult = matchShapes(myshape, tempshape, 1, 0);
			if (matchresult > 0.5)
			{
				cout << "Shape not match:" << matchresult << endl;
				continue;
			}
			solvePnP(realpos, centers, cameraMatrix, distCoeffs, rvecs, tvecs);
			Rodrigues(rvecs, R);
			Ang_X = asin(R.at<double>(1, 0) / cos(asin(-R.at<double>(2, 0)))) / pi * 180;
			Ang_Y = asin(-R.at<double>(2, 0)) / pi * 180;
			Ang_Z = asin(R.at<double>(2, 1) / cos(asin(-R.at<double>(2, 0)))) / pi * 180;

			X = R.at<double>(0, 0) *realpos[0].x + R.at<double>(0, 1)  * realpos[0].y + R.at<double>(0, 2)  * realpos[0].z + tvecs.at<double>(0, 0);
			Y = R.at<double>(1, 0) *realpos[0].x + R.at<double>(1, 1)  * realpos[0].y + R.at<double>(1, 2)  * realpos[0].z + tvecs.at<double>(1, 0);
			Z = R.at<double>(2, 0) *realpos[0].x + R.at<double>(2, 1)  * realpos[0].y + R.at<double>(2, 2)  * realpos[0].z + tvecs.at<double>(2, 0);
			putText(ima, "X:" + to_string(X), { 1, 50 }, 0, 1.0f, CV_RGB(255, 0, 0), 2);
			putText(ima, "Y:" + to_string(Y), { 1, 150 }, 0, 1.0f, CV_RGB(0, 255, 0), 2);
			putText(ima, "Z:" + to_string(Z), { 1, 250 }, 0, 1.0f, CV_RGB(0, 0, 255), 2);
			putText(ima, "Ang_X:" + to_string(Ang_X), { 300, 50 }, 0, 1.0f, CV_RGB(255, 0, 0), 2);
			putText(ima, "Ang_Y:" + to_string(Ang_Y), { 300, 150 }, 0, 1.0f, CV_RGB(0, 255, 0), 2);
			putText(ima, "Ang_Z:" + to_string(Ang_Z), { 300, 250 }, 0, 1.0f, CV_RGB(0, 0, 255), 2);
		}

这个代码是应用在了一个无人机上,所以图像获取部分等其他代码就不放了,但是核心原理都在上面了。

再放一下识别结果:


  • 4
    点赞
  • 10
    收藏
    觉得还不错? 一键收藏
  • 3
    评论
import cv2 as cv import numpy as np def hough_circle(image): #因为霍夫检测对噪声很明显,所以需要先滤波一下。 dst =cv.pyrMeanShiftFiltering(image,10,100) cimage=cv.cvtColor(dst,cv.COLOR_BGR2GRAY) circles = cv.HoughCircles(cimage,cv.HOUGH_GRADIENT,1,40,param1=40,param2=29,minRadius=30,maxRadius=0) #把circles包含的圆心和半径的值变为整数 circles = np.uint16(np.around(circles)) for i in circles[0]: cv.circle(image,(i[0],i[1]),i[2],(0,255,0),3) cv.imshow("circle",image) src = cv.imread("E:/opencv/picture/coins.jpg") cv.imshow("inital_window",src) hough_circle(src) cv.waitKey(0) cv.destroyAllWindows() 霍夫圆变换的基本思路是认为图像上每一个非零像素都有可能是一个潜在的圆上的一, 跟霍夫线变换一样,也是通过投票,生成累积坐标平面,设置一个累积权重来定位圆。 在笛卡尔坐标系中圆的方程为: 其中(a,b)是圆心,r是半径,也可以表述为: 即 在笛卡尔的xy坐标系中经过某一的所有圆映射到abr坐标系中就是一条三维的曲线: 经过xy坐标系中所有的非零像素的所有圆就构成了abr坐标系中很多条三维的曲线。 在xy坐标系中同一个圆上的所有的圆方程是一样的,它们映射到abr坐标系中的是同一个,所以在abr坐标系中该就应该有圆的总像素N0个曲线相交。 通过判断abr中每一的相交(累积)数量,大于一定阈值的就认为是圆。 以上是标准霍夫圆变换实现算法。 问题是它的累加到一个三维的空间,意味着比霍夫线变换需要更多的计算消耗。 Opencv霍夫圆变换对标准霍夫圆变换做了运算上的优化。 它采用的是“霍夫梯度法”。它的检测思路是去遍历累加所有非零对应的圆心,对圆心进行考量。 如何定位圆心呢?圆心一定是在圆上的每个的模向量上,即在垂直于该并且经过该的切线的垂直线上,这些圆上的模向量的交就是圆心。 霍夫梯度法就是要去查找这些圆心,根据该“圆心”上模向量相交数量的多少,根据阈值进行最终的判断。 bilibili: 注意: 1.OpenCV的霍夫圆变换函数原型为:HoughCircles(image, method, dp, minDist[, circles[, param1[, param2[, minRadius[, maxRadius]]]]]) -> circles image参数表示8位单通道灰度输入图像矩阵。 method参数表示圆检测方法,目前唯一实现的方法是HOUGH_GRADIENT。 dp参数表示累加器与原始图像相比的分辨率的反比参数。例如,如果dp = 1,则累加器具有与输入图像相同的分辨率。如果dp=2,累加器分辨率是元素图像的一半,宽度和高度也缩减为原来的一半。 minDist参数表示检测到的两个圆心之间的最小距离。如果参数太小,除了真实的一个圆圈之外,可能错误地检测到多个相邻的圆圈。如果太大,可能会遗漏一些圆圈。 circles参数表示检测到的圆的输出向量,向量内第一个元素是圆的横坐标,第二个是纵坐标,第三个是半径大小。 param1参数表示Canny边缘检测的高阈值,低阈值会被自动置为高阈值的一半。 param2参数表示圆心检测的累加阈值,参数值越小,可以检测越多的假圆圈,但返回的是与较大累加器值对应的圆圈。 minRadius参数表示检测到的圆的最小半径。 maxRadius参数表示检测到的圆的最大半径。 2.OpenCV画圆的circle函数原型:circle(img, center, radius, color[, thickness[, lineType[, shift]]]) -> img img参数表示源图像。 center参数表示圆心坐标。 radius参数表示圆的半径。 color参数表示设定圆的颜色。 thickness参数:如果是正数,表示圆轮廓的粗细程度。如果是负数,表示要绘制实心圆。 lineType参数表示圆线条的类型。 shift参数表示圆心坐标和半径值中的小数位数。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 3
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值