规划算法分两部分,此为part1