Visual method including binocular stereo vision method and monocular vision method of the relative position ... Using KD-TREE to find the nearest point, a hyper rectangle hr and a hyper circle should ...