摄像头标定实施

摄像头标定实施

一.标定流程

在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()