摄像头标定实施

摄像头标定实施

一.标定流程

在opencv中提供了一组函数用于实现相机的标定,标定返回的值包括:相机内参矩阵(fx fy xc yc)、相机外参矩阵(R t)以及畸变矩阵。

标定的步骤如下:

1. 准备棋盘格,棋盘格图片可以自行打印,以下使用10*7方格的棋盘格,交点则为9*6,棋盘格的大小1mm,即 gridsize=1

2. 拍照,拍照的原则是多角度,根据理论至少要两种角度的拍照,实际中通常会拍20张左右;

3. 使用opencv提供的角点检测函数findChessboardCorners找到棋盘格中的角点,并将每幅图片的角点值存放到list中,同时将棋盘格的角点的三维坐标存放到另一个list。

4. 使用calibrateCamera函数获取内存矩阵、畸变矩阵、旋转矩阵以及转移矩阵。

5.使用undistort函数将畸变的图像进行校正并查看校正后的图片效果。

二.README.md

calibrate camera 相机校正,使用opencv自带的函数库,计算出如下几个参数。

内参矩阵: 3*3
In [22]: mtx
Out[22]:
array([[1.16022336e+03, 0.00000000e+00, 6.68285471e+02],
[0.00000000e+00, 1.15738493e+03, 3.89459697e+02],
[0.00000000e+00, 0.00000000e+00, 1.00000000e+00]])

畸变矩阵: 1*5
In [25]: dist
Out[25]: array([[-0.25129777, 0.02823272, -0.00053603, 0.00037274,-0.08995589]])

旋转矩阵:
In [27]: rvecs
Out[27]: 18*(3*1)
[array([[ 0.03558055], [-0.03112721], [-0.00755535]]),
array([[ 0.63788424], [-0.04903354], [ 0.01762295]]),
array([[-0.44908256], [-0.06512295], [-0.01916963]]),
array([[ 0.01780734], [ 0.0209126 ], [-0.00558506]]),
array([[0.02198169], [0.6367404 ], [0.00977959]]),
array([[ 0.03046199], [-0.7040381 ], [-0.01932221]]),
array([[-0.19237824], [-0.75952006], [ 0.1201012 ]]),
array([[ 0.51440228], [-0.2194547 ], [ 0.02910641]]),
array([[0.03761499], [0.45929723], [0.00663988]]),
array([[0.03691831], [0.64815823], [0.01041448]]),
array([[-0.3272451 ], [ 0.65900314], [-0.41478724]]),
array([[ 0.05770817], [-0.51997066], [-0.00538347]]),
array([[-0.01886995], [-0.48934854], [ 0.01885913]]),
array([[ 0.04012555], [-0.46639335], [-0.05743551]]),
array([[ 0.18608573], [-0.05068572], [-0.00117477]]),
array([[ 0.22181091], [-0.06412907], [ 0.0115335 ]]),
array([[0.0882598 ], [0.38487441], [0.05529661]]),
array([[-0.01748482], [ 0.38362373], [-0.00271536]])]

平移向量: 18*(3*1)
In [33]: tvecs
Out[33]:
[array([[-4.21904478], [-2.32362579], [ 8.49747635]]),
array([[-3.81963279], [-1.62195346], [ 7.98860175]]),
array([[-4.39150219], [-3.07999134], [10.75041784]]),
array([[-4.94259067], [-3.93663095], [30.57685167]]),
array([[-9.62311687], [-3.36509195], [32.2423649 ]]),
array([[ 0.73000489], [-2.96584094], [19.6837078 ]]),
array([[-0.85448692], [-4.63545431], [21.80683115]]),
array([[-2.09590548], [-0.77674132], [19.65246328]]),
array([[-16.99384696],[ -3.57759924],[ 32.14998811]]),
array([[-0.19382096], [-3.52948313], [21.95184873]]),
array([[-6.04109212], [-1.6349801 ], [26.75950346]]),
array([[ 5.40125149], [-4.50757377], [20.8880559 ]]),
array([[ 4.51225567], [-1.52138071], [20.08076553]]),
array([[ 4.91858056], [-5.1101675 ], [19.89170706]]),
array([[-3.63023758], [-4.17313449], [17.87154811]]),
array([[-3.96462648], [-1.36057071], [17.1048456 ]]),
array([[-13.02067108],[ -5.65276501],[ 23.81054552]]),
array([[-13.4309631 ],[ -0.55047404],[ 24.62701854]])]

通过计算后的参数生成未畸变的图片image.jpg

三.calibrate.py

#!/usr/bin/env python3

   

# -*- coding: utf-8 -*-

 

"""

 

Created on Wed Oct 16 08:45:25 2019

  
 

@author: hmeng

 

"""

  
 

import numpy as np

 

import cv2

  
 

objp_dict = {

 

1: (9, 5),

 

2: (9, 6),

 

3: (9, 6),

 

4: (9, 6),

 

5: (9, 6),

 

6: (9, 6),

 

7: (9, 6),

 

8: (9, 6),

 

9: (9, 6),

 

10: (9, 6),

 

11: (9, 6),

 

12: (9, 6),

 

13: (9, 6),

 

14: (9, 6),

 

15: (9, 6),

 

16: (9, 6),

 

18: (9, 6),

 

17: (9, 6),

 

19: (9, 6),

 

20: (9, 6),

 

}

  
 

objp_list = []

 

corners_list = []

  
 

for k in objp_dict:

 

nx, ny = objp_dict[k]

 

# Prepare object points, like (0,0,0), (1,0,0), (2,0,0) ....,(6,5,0)

 

objp = np.zeros((nx*ny,3), np.float32)

  
 

objp[:,:2] = np.mgrid[0:nx, 0:ny].T.reshape(-1,2)

 

# Make a list of calibration images

 

fname = ‘camera_cal/calibration%s.jpg‘ % str(k)

 

img = cv2.imread(fname)

  
 

# Convert to grayscale

 

gray = cv2.cvtColor(img, cv2.COLOR_BGR2GRAY)

  
 

# Find the chessboard corners

 

ret, corners = cv2.findChessboardCorners(gray, (nx, ny), None)

  
 

# If found, save & draw corners

 

if ret == True:

 

# Save object points and corresponding corners

 

objp_list.append(objp)

 

corners_list.append(corners)

 

# Draw and display the corners

 

#cv2.drawChessboardCorners(img, (nx, ny), corners, ret)

 

#plt.imshow(img)

 

#plt.show()

 

#print(‘Found corners for %s‘ % fname)

 

else:

 

print(‘Warning: ret = %s for %s‘ % (ret, fname))

  
 

img = cv2.imread(‘camera_cal/calibration1.jpg‘)

 

img_size = (img.shape[1], img.shape[0])

 

‘‘‘

 

mtx :

 

dist:

  
  
 

‘‘‘

 

ret, mtx, dist, rvecs, tvecs = cv2.calibrateCamera(objp_list, corners_list, img_size,None,None)

  
  
 

dst = cv2.undistort(img, mtx, dist, None, mtx)

 

com_img = np.hstack((img, dst))

 

cv2.namedWindow(‘image‘, cv2.WINDOW_NORMAL)

 

cv2.imshow(‘image‘, com_img)

 

cv2.waitKey(0)

 

cv2.destroyAllWindows()

相关推荐