I'm currently trying to implement the triangulation algorithm proposed by Hartley and Sturm (here) and I'm having some difficulties. I think I understand the idea behind it, but I'm not sure how to parameterize the pencil of epipolar lines.
Given two images, and the estimated fundamental matrix between them, how can I:
1) Find the epipole coordinates in both images?
2) Transform the images so that each desired point is in the origin and the epipole is in one of the axis?
3) Calculate the new fundamental matrix which has a special form (see paper page 5)?
Afterwards, I think I can find the distance polynomial and minimize it, but these steps are the ones holding me back.
I'm using OpenCV and some example code would be great :)