Notch filter center frequency

A 5" will not fly on default PID’s and I’m not sure what you were trying to do with the PSC_ACCZ parameters but they are not correct. The outputs are oscillating badly. In any case go here and start the configuration process from default:
The Configurator

As this has nothing to do with the notch filter if you have further questions start a new thread.