POI: added calculation of the angle
ROOMBA: Go to poi implementation started
ROOMBA: Go to POI improved, still issues in turning angle
ROOMBA: Fixed Go to POI after refactoring