Rework the math, works now besides some ailsing at high angles and total failure when the camera is in crazy positions like under the map.