Added a PID controller class.

Added a class (struct and code) to implement a PID controller.