Added Arduino code
Code cleanup