Implemented SpeedPID

This is an enhancement to the PID Glue/Shim concept. SpeedPID is a
PIDController that also inherits the SpeedController interface.

Some of the syntax may need tweaking because I cannot compile.