Work on SmartPIDController.

All passthrough functions present, but I management is not done yet.

TODO: Work on I management and figure out range determination.
Fixed some implementation details in SmartPIDController.cpp