TODO:
(1)用python接受规划点
(2)把候选点放在场景中,规划一下