Add logging to log cli
Fix bugs in Pathfinder.

Fix publish directions and path
Fix incorrect direction converter
Add topics for Path and Directions Topic