Re-write for MEGA328P and capacitive sensing

Moved state machine into main file
Removed references to IR sensor
Removed software serial library
Added full LLAP library
Added basic cap sense filtering