[#538] almost working collisionAngle

also fixed the `angleTo` and `angleToPoint` functions