Update on my SPH/G

I just solved the one problem stopping me from completing the SPH. Math.

Well I didn't solve it, but a professor in YouTube did. But I did find the solution for the problem (which was negative height not working) my self and i am proud of myself for that. (All so don't ask me math related questions because make no mistake,i am terrible at math.)
So expect a finished SPH/G from me with funky tree aiming by either typing in the longitude,latitude and altitude by your self or getting it automatically by selecting a target. (YES IT WILL COMPENSATE FOR ALTITUDE DIFFERENCE) and full interior any time soon.
It won't compensate for movement though.

This is the one. Still needs some work.