Encoder tuning
PID with encoder testing code