Dynamic notch SDFT

This is an attempt to further improve the dynamic notch filter

• Frequency resolution increased 3 times
• Slightly less CPU intensive(!)
• Improved peak tracking
• Implemented fast approximation for sqrtf(x)