Added arduino code for motor control