Pose estimation
Use inter-point distance constraints
[Quan 99][Ameller 00]
Solve set of polynomial equations in xi2p
Recover R,t using procrustes analysis.
34