Dijkstra integration code added. Need to clean up code, finished the
dijkstra task. Also have dijkstra transferring directions array to the
state machine task.