I have a camera coordinate system defined by rotation matrix R
and translation T
with respect to the world coordinate system. A plane is defined in the camera coordinate by the normal N
and point P
on it. I want to find the equation of the plane in the world coordinate system. Currently I'm doing it is:
Transform P to world system by (P + T)
Transform N to world system by R.N
Then I'm finding the equation of the plan using the transformed P
and N
. I have two questions:
1) If we take the perpendicular distance of the camera center to the plane in camera coordinate system, that should be equal to the perpendicular distance of camera location to plane in world coordinate system, right ?
2) Assuming the above is true, my current transformation is giving incorrect results for example plane of N=[1,2,1]
and P=[1,4,0]
(in camera) and R = (90, 0, 90)
in XYZ euler and T =[3, 3, 9]
Am I doing something wrong ? Thanks