Added a bunch of class documentation for DOxygen.
Working on test files for the pid controller.