Python+OpenCV学习（19）---摄像机位姿估计

最新推荐文章于 2025-05-15 18:56:59 发布

原创

最新推荐文章于 2025-05-15 18:56:59 发布 · 5.5k 阅读

16 ·

CC 4.0 BY-SA版权

利用python学习OpenCV，个人感觉比较方便。函数的形式与C++基本相同，所以切换过来还是比较好的，对于像我这种对python不太熟练的人，使用python的集成开发环境PyCharm进行学习，可以设置断点调试，有助于我这类初学者理解掌握。

下面是利用python语言结合OpenCV进行摄像机位姿估计的代码：

# -*- coding:utf-8 -*-
__author__ = 'Microcosm'

import cv2
import numpy as np
import glob

# 加载数据
with np.load('B.npz') as X:
    mtx, dist, _, _ = [X[i] for i in ('mtx','dist','rvecs','tvecs')]

def draw(img,corners, imgpts):
    corner = tuple(corners[0].ravel())
    cv2.line(img, corner, tuple(imgpts[0].ravel()), (255,0,0), 5)
    cv2.line(img, corner, tuple(imgpts[1].ravel()), (0,255,0), 5)
    cv2.line(img, corner, tuple(imgpts[2].ravel()), (0,0,255), 5)
    return img

def draw2(img,imgpts):
    imgpts = np.int32(imgpts).re