Fix NaN
Merge pull request #1846 from alex55i/nan

Fix getAngleAroundRad returning NaN