come tu stesso hai detto è un problema di trigonometria.
se lavori su piccole distanze tuttavia non c'è bisogno di fare il calcolo pensando alla sfericità del pianeta, visto che su brevi distanze la forma della terra influisce davvero in maniera minima. In tal caso puoi anche considerarlo come se fosse un piano.