I literally gave you code for that. Seriously, it's math. There is no magic Engine function. And it IS a "google for me, plox" request.

Shitlord by trade and passion. Graphics programmer at Laminar Research.
I write blog posts at feresignum.com