WORKING DISTANCE MEASUREMENT ! Encoder calibration added, Chord calculation added, AHRS application added