Cleaned up Arduino Sketch