提交基本的A星寻路算法
基于障碍躲避信息的O(n)算法在多障碍物重叠的情况下仍然有问题，暂时无法提交到kit库