Added basic unit-testing to the PID controller.