lesto:
se invece vuoi seguire la strada per la distanza, almeno usa il codice per la distanza che ho postato "a prova di virgola mobile"
Non puoi gestire calcoli trigonometrici con valori angolari a sei cifre decimali con i float a 32 bit senza perdere tantissima risoluzione/precisione.
Qui si parla di apprezzare variazioni di non più di un metro di percorso, ovvero poco meno di 10 milionesimi di grado inteso come distanza angolare sulla sfera terrestre.
Le tue formule le ho provate, forniscono risultati totalmente sbagliati sulla distanza se applicate a 32 bit, non le ho provate a 64 bit, l'angolo è meno critico da calcolare e forse si riesce a farlo pure a 32 bit, ma senza la distanza non serve a nulla.