PID controller with tests, ready for testing