ara_star.py 429 B

123456789101112131415161718192021
  1. import queue
  2. import plotting
  3. import env
  4. class AraStar:
  5. def __init__(self, x_start, x_goal):
  6. self.xI, self.xG = x_start, x_goal
  7. self.Env = env.Env() # class Env
  8. self.u_set = self.Env.motions # feasible input set
  9. self.obs = self.Env.obs # position of obstacles
  10. def main():
  11. x_start = (5, 5) # Starting node
  12. x_goal = (49, 5) # Goal node
  13. arastar = AraStar(x_start, x_goal)