Cleaned up oscillator implementation. Added notch filter.