Files
PathPlanning/Search-based Planning/Search_2D/test.py
T
zhm-real 89ecf8c810 update
2020-06-30 14:12:07 -07:00

21 lines
343 B
Python

"""
A_star 2D
@author: huiming zhou
"""
import os
import sys
sys.path.append(os.path.dirname(os.path.abspath(__file__)) +
"/../../Search-based Planning/")
from Search_2D import queue
from Search_2D import plotting
from Search_2D import env
U = queue.QueuePrior()
U.put((1, 2), [2, 3])
U.put((2, 3), [1, 5])
print(U.get())