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

Did the OP ask about analogWrite?
No.
Did the OP ask about PWM pins?
No.

The OP asked how to calculate the correct PWM to steer a servo.