added lock and unkock, mag calibration、acc calibration and angel trim functions.