magcalib: 0 compass 2 before calib
sonar add exception check