Ayuda proyecto medicion THD

Buenas tardes compañeros, hace un mes me compre el arduino mega 2560 para realizar un proyecto que consiste en lo siguiente:
Necesito medir la THD (Distorsión Armónica Total) de un circuito amplificador de sonido, la THD se define como la sumatoria de las magnitudes de todos los armónicos (menos el primero) al cuadrado dividido entre la magnitud del primer armónico.
Lo que se me ocurre es hacer una especie de FFT en arduino y tomar los armonicos, pero no se que otra idea me podrían aconsejar, ademas, tampoco es que tenga el código para realizar la FFT en arduino, de pronto también me puedan colaborar con eso, gracias.