I have 4 2D points in screen-space, and I need to reverse-project them back into 3D space. I know that each of the 4 points is a corner of a 3D-rotated rigid rectangle, and I know the size of the rectangle. How can I get 3D coordinates from this?
I am not using any particular API, and I do not have an existing projection matrix. I'm just looking for basic math to do this. Of course there isn't enough data to convert a single 2D point to 3D with no other reference, but I imagine that if you have 4 points, you know that they're all at right-angles to each other on the same plane, and you know the distance between them, you should be able to figure it out from there. Unfortunately I can't quite work out how though.
This might fall under the umbrella of photogrammetry, but google searches for that haven't led me to any helpful information.
Yes, Monte Carlo works, but I found better solution for this issue. This code works perfectly (and uses OpenCV):
This function takes known 3d and 2d points, size of screen and returns rotation (rvecs[0]), translation (tvecs[0]) and matrix of intrinsics values of camera. It's everything you need.
Alright, I came here looking for an answer and didn't find something simple and straightforward, so I went ahead and did the dumb but effective (and relatively simple) thing: Monte Carlo optimisation.
Very simply put, the algorithm is as follows: Randomly perturb your projection matrix until it projects your known 3D coordinates to your known 2D coordinates.
Here is a still photo from Thomas the Tank Engine:
Let's say we use GIMP to find the 2D coordinates of what we think is a square on the ground plane (whether or not it is really a square depends on your judgment of the depth):
I get four points in the 2D image:
(318, 247)
,(326, 312)
,(418, 241)
, and(452, 303)
.By convention, we say that these points should correspond to the 3D points:
(0, 0, 0)
,(0, 0, 1)
,(1, 0, 0)
, and(1, 0, 1)
. In other words, a unit square in the y=0 plane.Projecting each of these 3D coordinates into 2D is done by multiplying the 4D vector
[x, y, z, 1]
with a 4x4 projection matrix, then dividing the x and y components by z to actually get the perspective correction. This is more or less what gluProject() does, exceptgluProject()
also takes the current viewport into account and takes a separate modelview matrix into account (we can just assume the modelview matrix is the identity matrix). It is very handy to look at thegluProject()
documentation because I actually want a solution that works for OpenGL, but beware that the documentation is missing the division by z in the formula.Remember, the algorithm is to start with some projection matrix and randomly perturb it until it gives the projection that we want. So what we're going to do is project each of the four 3D points and see how close we get to the 2D points we wanted. If our random perturbations cause the projected 2D points to get closer to the ones we marked above, then we keep that matrix as an improvement over our initial (or previous) guess.
Let's define our points:
We need to start with some matrix, identity matrix seems a natural choice:
We need to actually implement the projection (which is basically a matrix multiplication):
This is basically what
gluProject()
does, 720 and 576 are the width and height of the image, respectively (i.e. the viewport), and we subtract from 576 to count for the fact that we counted y coordinates from the top while OpenGL typically counts them from the bottom. You'll notice we're not calculating z, that's because we don't really need it here (though it could be handy to ensure it falls within the range that OpenGL uses for the depth buffer).Now we need a function for evaluating how close we are to the correct solution. The value returned by this function is what we will use to check whether one matrix is better than another. I chose to go by sum of squared distances, i.e.:
To perturb the matrix, we simply pick an element to perturb by a random amount within some range:
(It's worth noting that our
project()
function doesn't actually usemat[2]
at all, since we don't compute z, and since all our y coordinates are 0 themat[*][1]
values are irrelevant as well. We could use this fact and never try to perturb those values, which would give a small speedup, but that is left as an exercise...)For convenience, let's add a function that does the bulk of the approximation by calling
perturb()
over and over again on what is the best matrix we've found so far:Now all that's left to do is to run it...:
I find this already gives a pretty accurate answer. After running for a while, the matrix I found was:
with an error of around
2.6e-5
. (Notice how the elements we said were not used in the computation have not actually been changed from our initial matrix; that's because changing these entries would not change the result of the evaluation and so the change would never get carried along.)We can pass the matrix into OpenGL using
glLoadMatrix()
(but remember to transpose it first, and remember to load your modelview matrix with the identity matrix):Now we can for example translate along the z axis to get different positions along the tracks:
For sure this is not very elegant from a mathematical point of view; you don't get a closed form equation that you can just plug your numbers into and get a direct (and accurate) answer. HOWEVER, it does allow you to add additional constraints without having to worry about complicating your equations; for example if we wanted to incorporate height as well, we could use that corner of the house and say (in our evaluation function) that the distance from the ground to the roof should be so-and-so, and run the algorithm again. So yes, it's a brute force of sorts, but works, and works well.
To follow up on Rons approach: You can find your z-values if you know how you've rotated your rectangle.
The trick is to find the projective matrix that did the projection. Fortunately this is possible and even cheap to do. The relevant math can be found in the paper "Projective Mappings for Image Warping" by Paul Heckbert.
http://pages.cs.wisc.edu/~dyer/cs766/readings/heckbert-proj.pdf
This way you can recover the homogenous part of each vertex back that was lost during projection.
Now you're still left with four lines instead of points (as Ron explained). Since you know the size of your original rectangle however nothing is lost. You can now plug the data from Ron's method and from the 2D approach into a linear equation solver and solve for z. You get the exact z-values of each vertex that way.
Note: This just works because:
It's a special case really.
Hope it helps, Nils
From the 2-D space there will be 2 valid rectangles that can be built. Without knowing the original matrix projection, you won't know which one is correct. It's the same as the "box" problem: you see two squares, one inside the other, with the 4 inside vertices connected to the 4 respective outside vertices. Are you looking at a box from the top-down or the bottom-up?
That being said, you are looking for a matrix transform T where...
{{x1, y1, z1}, {x2, y2, z2}, {x3, y3, z3}, {x4, y4, z4}} x T = {{x1, y1}, {x2, y2}, {x3, y3}, {x4, y4}}
(4 x 3) x T = (4 x 2)
So T must be a (3 x 2) matrix. So we've got 6 unknowns.
Now build a system of constraints on T and solve with Simplex. To build the constraints, you know that a line passing through the first two points must be parallel to the line passing to the second two points. You know a line passing through points 1 and 3 must be parallel to the lines passing through points 2 and 4. You know a line passing through 1 and 2 must be orthogonal to a line passing through points 2 and 3. You know that the length of the line from 1 and 2 must equal the length of the line from 3 and 4. You know that the length of the line from 1 and 3 must equal the length of the line from 2 and 4.
To make this even easier, you know about the rectangle, so you know the length of all the sides.
That should give you plenty of constraints to solve this problem.
Of course, to get back, you can find T-inverse.
@Rob: Yes, there are an infinite number of projections, but not an infinite number of projects where the points must satisfy the requirements of a rectangle.
@nlucaroni: Yes, this is only solvable if you have four points in the projection. If the rectangle projects to just 2 points (i.e. the plane of the rectangle is orthogonal to the projection surface), then this cannot be solved.
Hmmm... I should go home and write this little gem. This sounds like fun.
Updates:
The projection you have onto the 2D surface has infinitely many 3D rectangles that will project to the same 2D shape.
Think about it this way: you have four 3D points that make up the 3D rectangle. Call them (x0,y0,z0), (x1,y1,z1), (x2,y2,z2) and (x3,y3,z3). When you project these points onto the x-y plane, you drop the z coordinates: (x0,y0), (x1,y1), (x2,y2), (x3,y3).
Now, you want to project back into 3D space, you need to reverse-engineer what z0,..,z3 were. But any set of z coordinates that a) keep the same x-y distance between the points, and b) keep the shape a rectangle will work. So, any member of this (infinite) set will do: {(z0+i, z1+i, z2+i, z3+i) | i <- R}.
Edit @Jarrett: Imagine you solved this and ended up with a rectangle in 3D space. Now, imagine sliding that rectangle up and down the z-axis. Those infinite amount of translated rectangles all have the same x-y projection. How do you know you found the "right" one?
Edit #2: Alright, this is from a comment I made on this question -- a more intuitive approach to reasoning about this.
Imagine holding a piece of paper above your desk. Pretend each corner of the paper has a weightless laser pointer attached to it that points down toward the desk. The paper is the 3D object, and the laser pointer dots on the desk are the 2D projection.
Now, how can you tell how high off the desk the paper is by looking at just the laser pointer dots?
You can't. Move the paper straight up and down. The laser pointers will still shine on the same spots on the desk regardless of the height of the paper.
Finding the z-coordinates in the reverse-projection is like trying to find the height of the paper based on the laser pointer dots on the desk alone.
When you project from 3D to 2D you lose information.
In the simple case of a single point the inverse projection would give you an infinite ray through 3d space.
Stereoscopic reconstruction will typically start with two 2d images and project both back to 3D. Then look for an intersection of the two 3D rays produced.
Projection can take different forms. Orthogonal or perspective. I'm guessing that you are assuming orthogonal projection?
In your case assuming you had the original matrix you would have 4 rays in 3D space. You would then be able to constrain the problem by your 3d rectangle dimensions and attempt to solve.
The solution will not be unique as a rotation around either axis that is parallel to the 2d projection plane will be ambiguous in direction. In other words if the 2d image is perpendicular to the z axis then rotating the 3d rectangle clockwise or anti clockwise around the x axis would produce the same image. Likewise for the y axis.
In the case where the rectangle plane is parallel to the z axis you have even more solutions.
As you don't have the original projection matrix further ambiguity is introduced by an arbitary scaling factor that exists in any projection. You cannot distinguish between a scaling in the projection and a translation in 3d in the direction of the z axis. This is not a problem if you are only interested in the relative positions of the 4 points in 3d space when related to each other and not to the plane of the 2d projection.
In a perspective projection things get harder...