Rectification code from someone, see here: https://github.com/ipa320/softkinetic/issues/25#issuecomment-53232764