Added pseudocode in preparation for the next phase. Fixed a few bugs.
Completely rewrote the Sensor code to work with timers and add debug lighting. Controller code only slightly changed.
Merge pull request #3 from ameske/master

Rewrote Sensor code to incorporate timing. Minimized use of global variables. Slight naming changes.