Added Interpolation functions and changed math to use angle tuple