Major Changes

Removed all for loops and if statements. Made the code easier to read as
well as added comments. Still not convinced the code will actually run
on the Arduino.