Modified Arduino: Motor control works (mostly)

Some more playing with the control parameters may be necessary.