Ported the add method
Coompleted the AStar class and example
Updated roadmap