Update PID.h

The changes are meant to allow for easy usage of the technique of multi sampling. 
These two classes are kept together as they are essentially the same.