Minor bug fixes ongoing LPCSensors PID algo tweaks