position_estimator_inav: minor bug fixed, write debug log on crash