Removed hysteresis. Added pwm spiking. Calibrated pid. I-Term included again

Results look promising.