A implementation of a grid based planner using Dijkstras or A*