PID controller implementation and PI Test
Derivative test