How can I detect known frequencies using most efficient algorithm
A better way to use a Goertzel filter, than with a fixed threshold, is to compare a narrow-band Goertzel filter output with the energy of the total signal or a wider bandwidth Goertzel filter.  Look for a peak statistically above a level corresponding to the wider noise energy level.