in ten_hz_logginh_loop() auto change mode from GUIDED to POSHOLD if reach the destnation;in MAVLINK_CMD_NAV_TAKEOFF case changed to set_mode\arm\takeoff auto