Senior design robot Arduino code