Oscillation Detection

Added the ability to detect oscillation to the PIDAutotune