The angle calculated by shortedAngleBetween was incorrect. Fixed this to...

... work correctly