remove EnvironmentChecker
add NaviGridBasedEnvUtil
GridBasedEnv -> GridEnv
GridEnvOctPathPopEachNode
GridEnvOctPathPopDirectlyReachableNode
nothing
AStar返回路径中不包含起点和终点