Moved Arduino Sketch

Moved the sketch and cleaned up the code.