adding P control to Pololu Motors lib