Arduino now controlling RHS motor near-correctly