机器人运动规划,并且在遇到障碍物时候能够避开障碍点,有最短距离和非最短距离两种