Globally optimal solution to exploit rigidity when recovering structure from motion under occlusion