Arduino-IDE compatibility
Cleaned up #includes
PID correction