POI: Added calculation of the angle
POI: Fixes to functionality, still issues in angle calculation
POI: Fixes after refactoring
POI: Calculation of angle fixed