Plane detection with ransac added