POI: added calculation of the angle
Removed comment blocks
ROOMBA: Go to poi implementation started
ROOMBA: Go to POI improved, still issues in turning angle