因此。我有4组坐标对。一个在世界坐标中,另一个在相机坐标中。
+-----+-----+-----+-----+-----+
| Xw | Yw | Zw | Xc | Yc |
+-----+-----+-----+-----+-----+
| 0,0 | 0,0 | 0,0 | 582 | 344 |
| 7,0 | 0,0 | 0,0 | 834 | 338 |
| 0,0 | 5,0 | 0,0 | 586 | 529 |
| 7,0 | 5,0 | 0,0 | 841 | 522 |
+-----+-----+-----+-----+-----+
Xw, Yw, Zw
- 世界坐标为Xc, Yc
- 相机坐标
Zw
- 始终为0
现在我需要计算一个变换矩阵。所以有Xw和Yw我可以产生Xc,Yc。
我也有相机2.然后,使用相机2的某个点位置,我需要在第一个相机坐标中计算相同的点。
+-------+-------+-------+-------+
| Xc2 | Yc2 | Xс1 | Yс1 |
+-------+-------+-------+-------+
| 1250 | 433 | 209 | 771 |
| 528 | 452 | 1277 | 730 |
+-------+-------+-------+-------+
# `Xc1` and `Yc1` just estimated for example - need to be calculated
我们还有来自OpenCV的摄像头2校准数据。
感谢。
P.S。如果您将使用python + numpy
描述如何操作,我将不胜感激P.s.s。如果您将它描述为橡皮鸭( wenk ):)
答案 0 :(得分:2)
您可能需要仔细考虑场景的几何形状,但线性代数可能会给您合理的结果。
如果我们使用您的世界坐标来拟合常规格式aX + bY +c
,那么我们可以使用numpy's lstsq函数进行最小二乘拟合。
world = numpy.array([
[0,0,0],
[7,0,0],
[0,5,0],
[7,4,0]])
camera = numpy.array([
[582,344],
[834,338],
[586,529],
[841,522]])
#Lose Z axis
world = world[:,0:2]
#Make a square matrix
A = numpy.vstack([world.T, numpy.ones(4)]).T
#perform the least squares method
x, res, rank, s = numpy.linalg.lstsq(A, camera, rcond=None)
#test results
print(numpy.dot(A,x))