Update motorRight pinnout

Update motorRight pinnout.
Clean up code