Added Pathfinder

A-Star implementation, works currently only outside Thymio environment but integration should be possible without too much effort...