NEW: method for calculating the direction of a point
FIXED: bug in calculating a vector in direction of the robo
NEW: basic route-functionality (currently not in use)