Working on init the cap touch. Set proper period and duty cycle for IRLED. Cleaned up code a bit.