Added motor control to arduino code