Added PID Controller class and test.  This class does not work yet, but
most public facing methods are there.