How to take 2 sets of coordinates and altitude and calculate angle for Servos

Servos aren't controlled using PWM.

They aren't?
Sh*t, I've been doing it wrong these past twenty years. 8)