Arduino motor shield sketch problems