Automatic driving path plan based on iterative and triple optimization method