The code I posted is derived from the Hacktronics tutorial. I believe it has all you need. Any maths you need is straighforward when you use floats.
The code I posted is derived from the Hacktronics tutorial. I believe it has all you need. Any maths you need is straighforward when you use floats.