Improved PID loop (Don't change the PWM value if it's not needed). Removed another warning. Logging stuff.