Merge branches 'Sarah' and 'HEAD'
Removed occupancygrid from the server. The server itself will subscribe to the topic
Adding baseline requirements to the a* server
Created the 3 gridCell topics
Added heuristic calculation
Added class for a*
Merge branches 'master' and 'HEAD' into Sarah