Create pid.h

Amtel PID code modified for Arduino. Has debug serial msgs to be removed