You can find C code for the Goertzel algorithm at: http://www.exstrom.com/journal/sigproc/index.html