Attempting to fix Encoder Code--motors "working" now, we think PID constants are off