一、PnP求解简介
PnP常用于对合作目标进行位姿估计,其中合作目标上存在相对位置关系已知的标志点,PnP是针对3D-2D映射关系的一种方法,OpenCV中已有PnP求解的实现函数solvePnP,函数声明如下:
CV_EXPORTS_W bool solvePnP( InputArray objectPoints, InputArray imagePoints,
InputArray cameraMatrix, InputArray distCoeffs,
OutputArray rvec, OutputArray tvec,
bool useExtrinsicGuess = false, int flags = SOLVEPNP_ITERATIVE );
其中:
flags:求解方法默认采用的是迭代的方法SOLVEPNP_ITERATIVE,另外还有:EPnP,CV_EPNP,UPnP等
rvec:rvec的第i列 表示世界坐标系中的第i个坐标轴方向的单位向量在摄像机坐标系里的坐标;
tvec:tvec表示世界坐标系的原点在摄像机坐标系的坐标;