added class PathFinder, which will decide which command has to be send
to the robot
forwarding parsed Pose to the mapper
added method in PathFinder that tries to find the next necessary action
using a Dijkstra algorithm