A implementation of a grid based planner using Dijkstra