Added diagonal compensation
Added DIAGONAL_COMPENSATION_FACTOR
Merge pull request #60 from kevinresol/dev

Added diagonal compensation