pidControl, simple OnFwd motor
pidControl which allows for OnRev motor