90%

功能上基本实现，现在重复寻路有些问题。