Implemented equalization for ir distance.
Merge branch 'ir-apfohl' into test-height-control-ir