Updated with new motor and encoder controller wiring