WIP #8: added astar library

vanderbiltrobotics · Mar 25, 2019 · 33d7c1e · 33d7c1e
1 parent e13feaf
commit 33d7c1e
Showing 1 changed file with 4 additions and 1 deletion.
diff --git a/robot_navigation/scripts/path_planning.py b/robot_navigation/scripts/path_planning.py
@@ -2,6 +2,7 @@
 
 # Import ROS packages
 import rospy
+import astar
 from geometry_msgs.msg import Pose, PoseStamped
 from nav_msgs.msg import Path, OccupancyGrid
 from nav_msgs.srv import GetMap
@@ -51,7 +52,9 @@ def update_map(self):
     # Compute a new route from start_pose to goal_pose and publish
     # Uses A* search algorithm to compute the route
     def generate_route(self):
-        pass
+        path = astar.AStar()
+        self.map = path.astar(self.start_pose,self.goal_pose)
+        print path
 
 
 if __name__ == "__main__":