PID working now working on everything else