Piecewise-Planar StereoScan:Structure and Motion from Plane Primitives
Closed-form solution of absolute orientation using unit quaternions