Somehow my PID tuning went OUT THE WINDOW! So I updated the PID
algorithm to include Derivative my Measurement and an alternate
run-away scheme.
Adding script to move striaght in a step function.