Made bumpless PID a bit more robust and added Adaptive PID class