Added priority queue comparison functon, made simple test example, queue holds actual map_node objets, not pointers to them
Changes the queue to hold pointers so that modifying the state of an element in the queue carries over to the map, realized it is dangerous to have fscore as a public value. If the score of an element in the queue is changed it does not auto re-sort the queue.