initial commit of PID controller and removed delay from status update to see how fast it can run