IR calibration routine added. Most stable code yet.
Seriously stable
EVEN MORE STABLE. ALMOST PERFECT
PERFECT!!!