Added motor test to Arduino code