Implementation 4: same as 2, but using RrtCon instead of RrtConCon. We espace the pocket really quick, but it can't find the solution in open space somehow