Make all headers starting from capital letter.
Unnecessary computation of arc cosine is omitted and convergence is checked on partial results. Original frequency is easily retrieved when needed.