OpenCV--摄像机图像畸变校正

转载出处：https://blog.csdn.net/tanmengwen/article/details/8555678

使用摄像头，采集一副图像，然后对图像畸变校正，摄像头事先标定好。

1. #include "cv.h"

2. #include "highgui.h"

3. #include "cxcore.h"

4. #include "cvcam.h"

5.  

6. //图像的像素直接提取

7. #define _I(img,x,y) ((unsigned char*)((img)->imageData + (img)->widthStep*(y)))[(x)]

8. //亚像素级灰度值

9. #define _IF(image,x,y) ( ((int)(x+1)-(x))*((int)(y+1)-(y))*_I((image),(int)(x),(int)(y)) + ((int)(x+1)-(x))*((y)-(int)(y))*_I((image),(int)(x),(int)(y+1)) + ((x)-(int)(x))*((int)(y+1)-(y))*_I((image),(int)(x+1),(int)(y)) + ((x)-(int)(x))*((y)-(int)(y))*_I((image),(int)(x+1),(int)(y+1)) )//插值后的像素值(IN表示interpolation),x、y可以为小数

10.  
11.  

12. void callback(IplImage* image);

13.  

14. void main()

15. {

16.  

17. int ncams = cvcamGetCamerasCount( );//返回可以访问的摄像头数目

18. HWND mywin;

19. cvcamSetProperty(0, CVCAM_PROP_ENABLE, CVCAMTRUE);

20. cvcamSetProperty(0, CVCAM_PROP_RENDER, CVCAMTRUE);

21. mywin = (HWND)cvGetWindowHandle("cvcam window");

22. cvcamSetProperty(0, CVCAM_PROP_WINDOW, &mywin);

23. cvcamSetProperty(0, CVCAM_PROP_CALLBACK, callback);

24.  

25. //cvcamGetProperty(0, CVCAM_VIDEOFORMAT,NULL);

26. cvNamedWindow( "径向矫正1", 1 );//创建窗口

27. cvNamedWindow( "径向矫正2", 1 );//创建窗口

28.  

29. cvcamInit( );

30. cvcamStart( );

31.  

32. cvWaitKey(0);

33.  

34. cvcamStop( );

35. cvcamExit( );

36. cvDestroyWindow( "径向矫正1" );//销毁窗口

37. cvDestroyWindow( "径向矫正2" );//销毁窗口

38.  

39. }

40.  

41. void callback(IplImage* image)

42. {

43.  

44. IplImage* Show1 = cvCreateImage( cvSize(320,240), IPL_DEPTH_8U, 1);

45. IplImage* Show2 = cvCreateImage( cvSize(420,340), IPL_DEPTH_8U, 1);

46. IplImage* ImageC1 = cvCreateImage( cvSize(320,240), IPL_DEPTH_8U, 1);

47.  

48. //转换为灰度图

49. cvCvtColor( image, ImageC1, CV_RGB2GRAY);

50. cvFlip( ImageC1, NULL, 0);

51.  

52. double *mi;

53. double *md;

54.  

55. mi = new double[3*3];

56. md = new double[4];

57.  

58. CvMat intrinsic_matrix,distortion_coeffs;

59.  

60. //摄像机内参数

61. cvInitMatHeader(&intrinsic_matrix,3,3,CV_64FC1,mi);

62.  

63. //镜头畸变参数

64. cvInitMatHeader(&distortion_coeffs,1,4,CV_64FC1,md);

65.  

66. /**//

67. 320*240 120度广角镜头

68. //参数由matlab获得

69. double fc1,fc2,cc1,cc2,kc1,kc2,kc3,kc4;

70. fc1 = 667.23923/2.5;

71. fc2 = 669.78156/2.5;

72. cc1 = 429.96933/2.5;

73. cc2 = 351.48350/2.5;

74. kc1 = -0.40100;

75. kc2 = 0.19463;

76. kc3 = 0.00508;

77. kc4 = -0.00051;

78.  

79. cvmSet(&intrinsic_matrix, 0, 0, fc1);

80. cvmSet(&intrinsic_matrix, 0, 1, 0);

81. cvmSet(&intrinsic_matrix, 0, 2, cc1);

82. cvmSet(&intrinsic_matrix, 1, 0, 0);

83. cvmSet(&intrinsic_matrix, 1, 1, fc2);

84. cvmSet(&intrinsic_matrix, 1, 2, cc2);

85. cvmSet(&intrinsic_matrix, 2, 0, 0);

86. cvmSet(&intrinsic_matrix, 2, 1, 0);

87. cvmSet(&intrinsic_matrix, 2, 2, 1);

88.  

89. cvmSet(&distortion_coeffs, 0, 0, kc1);

90. cvmSet(&distortion_coeffs, 0, 1, kc2);

91. cvmSet(&distortion_coeffs, 0, 2, kc3);

92. cvmSet(&distortion_coeffs, 0, 3, kc4);

93. /**/320*240 120度广角镜头

94. /

95.  

96. //矫正畸变(opencv)

97. cvUndistort2( ImageC1, Show1, &intrinsic_matrix, &distortion_coeffs);

98.  

99. //矫正畸变

100. for (int nx=0; nx<420; nx++)

101. {

102. for (int ny=0; ny<340; ny++)

103. {

104. double x=nx-50;

105. double y=ny-50;

106. double xx=(x-cc1)/fc1;

107. double yy=(y-cc2)/fc2;

108. double r2=pow(xx,2)+pow(yy,2);

109. double r4=pow(r2,2);

110. double xxx=xx*(1+kc1*r2+kc2*r4)+2*kc3*xx*yy+kc4*(r2+2*xx*xx);

111. double yyy=yy*(1+kc1*r2+kc2*r4)+2*kc4*xx*yy+kc3*(r2+2*yy*yy);

112. double xxxx = xxx*fc1+cc1;

113. double yyyy = yyy*fc2+cc2;

114. if (xxxx>0 && xxxx<320 && yyyy>0 && yyyy<240)

115. {

116. _I(Show2,nx,ny) = (int)_IF(ImageC1,xxxx,yyyy);

117. }

118. else

119. {

120. _I(Show2,nx,ny) = 0;

121. }

122.  

123. }

124. }

125.  
126.  
127.  
128.  

129. //画线

130. cvLine( Show1, cvPoint(0,10), cvPoint(320,10), cvScalar(255,255,255),3 );

131. cvLine( Show1, cvPoint(0,230), cvPoint(320,230), cvScalar(255,255,255),3 );

132. cvLine( Show1, cvPoint(10,0), cvPoint(10,240), cvScalar(255,255,255),3 );

133. cvLine( Show1, cvPoint(310,0), cvPoint(310,240), cvScalar(255,255,255),3 );

134. cvLine( Show1, cvPoint(0,0), cvPoint(320,240), cvScalar(255,255,255),3 );

135. cvLine( Show1, cvPoint(0,240), cvPoint(320,0), cvScalar(255,255,255),3 );

136.  

137. cvLine( Show1, cvPoint(0,10), cvPoint(320,10), cvScalar(0,0,0) );

138. cvLine( Show1, cvPoint(0,230), cvPoint(320,230), cvScalar(0,0,0) );

139. cvLine( Show1, cvPoint(10,0), cvPoint(10,240), cvScalar(0,0,0) );

140. cvLine( Show1, cvPoint(310,0), cvPoint(310,240), cvScalar(0,0,0) );

141. cvLine( Show1, cvPoint(0,0), cvPoint(320,240), cvScalar(0,0,0) );

142. cvLine( Show1, cvPoint(0,240), cvPoint(320,0), cvScalar(0,0,0) );

143.  

144. //显示

145. cvShowImage("径向矫正1", Show1);

146. cvShowImage("径向矫正2", Show2);

147. cvWaitKey(1);

148. cvReleaseImage( &Show1 );

149. cvReleaseImage( &Show2 );

150. cvReleaseImage( &ImageC1 );

151.  

152. }

http://www.cnblogs.com/wqj1212/archive/2008/01/25/1052875.html

 

一、标定

 关于摄像头的标定，说实话网上的资料太多了，方法也很多的。个人觉得想要研究这个的话，可以先了解基本原理，然后看opencv的例子calibration。如果你还了解的更深入的话，建议下载一些论文看看。

当然我推荐一个网址：http://www.ti-times.com/dfiles.asp?fl=download（深圳科创时代）我也是在查找资料的过程中发现的，觉得它上面为我们总结了很多有用的资料。

 

在这里说明一点。opencv的calibration是基于张正友标定法的，我们在标定的过程中要避免两次标定板的角度倾斜相差过小，这样会产生很大的误差（当然我们可以结合一些论文上的方法的来改进算法）。

 

上一张截图 ： http://hi.csdn.net/space-9784-do-album-picid-497526-goto-down.html（CSDN的blog上传图片功能被和谐了）

 

二、畸形矫正

其实在opencv的calibration这个例子中完成了畸形矫正。但是我在我的工程中，由于一些条件的限制，在没有做矫正的情况下，2.8的镜头刚好照满整个触摸区域，但是经过矫正后，由于主要是径向畸变，可是opencv是校正前后图像一样大小的做法，必然导致有一部分校正后的图像被裁剪了。没办法，我只好自己去按原理写最基本的校正算法了。现在贴一些基本算法原理出来。

 

图片 ： http://hi.csdn.net/space-9784-do-album-picid-497527-goto-down.html

 

具体代码如下：

1. //#pragma parallel omp for

2. for (int i = 0; i < realWidth; i ++)

3. {

4. //#pragma parallel omp for

5. for (int j = 0; j < realHeight; j ++)

6. {

7. // 图像物理坐标系中点在图像像素坐标系中的对应点u、v

8. double u = i - 65;

9. double v = j - 25;

10.  

11. // 根据图像在图像物理和图像像素坐标系中点的关系来计算图像物理坐标系中的点

12. //

13. // u = x / dx + u0 fx = 1 / dx

14. // v = y / dy + v0 fy = 1 / dy

15. double x = (u - u0) / fx;

16. double y = (v - v0) / fy;

17.  

18. double r2 = pow(x, 2) + pow(y, 2);

19. double r4 = pow(r2, 2);

20.  

21. double fr = 1 + k1 * r2 + k2 * r4 + k3 * r2 * r4;

22.  

23. double ud = (u - u0) * fr + u0;

24. double vd = (v - v0) * fr + v0;

25.  

26. int u0 = int(ud);

27. int v0 = int(vd);

28. int u1 = int(1 + ud);

29. int v1 = int(1 + vd);

30.  

31. if (ud > 0 && ud < 640 && vd > 0 && vd < 480)

32. {

33. fcImagePlus->image.pData[i + j * realWidth] = pixelInterpolation(tmpImage[0].image.pData,

34. ud, vd, u0, v0, u1, v1);

35. }

36. }

37. }

38.  

http://blog.csdn.net/li_007/article/details/5384937