Code to test encoders and PID parameters