I don’t see a need to revert the firmware. Follow the tuning guide, set up the filters, and re-tune AS PER THE TUNING GUIDE. But in 30-40 seconds of data it looked like it was doing what it was told to do.
Any reason for running the Dev version of firmware?
You will find this in the Mega Tuning guide but:
To collect data for the notch filter which should be configured before running Auto Tune:
INS_LOG_BAT_MASK,1
INS_LOG_BAT_OPT,4
MOT_PWM_TYPE,6 Dshot600 is generally the most stable unless you have some reason to use 300.
Read this Setting Motor Ranges
Set these based on the hover throttle value:
PSC_ACCZ_I
PSC_ACCZ_P
No ESC telemetry? Can’t use the Bdshot version of firmware?
Then flash the Bdshot version of firmware to the Flight Controller and configure for Bdshot.
Here if you want the stable version Orange Bdshot
Download the .apj file and flash it using Mission Planners “load custom firmware”
After fleshing the firmware configure for BDshot as per here bottom of the page Bdshot