Pose estimation
Solve orthographic problem, iterate
[DeMenthon 95]
Use inter-point distance constraints
[Quan 99][Ameller 00]
Solve set of polynomial equations in xi2p
(Xc,Yc,Zc)