/************************************************************************************ * I.MX6 GPS JNI HAL register init hacking * 声明： * 1. 本文主要是对Atheros GPS JNI、HAL层的代码进行初略的跟踪，主要想知道GPS设备 * 在这两层是如何注册、数据解析，目前还没分析Framework层进行分析。 * 2. 由于采用vim编辑文档，且分析文档的宽度超过博客园的文本宽度，如果想要阅读， * 尽量cp到自己文档里面，宽度足够，用vim进行阅读比较方便。 * 3. 不要在本博客上直接阅读，请采纳2中的意见。 * * 2015-11-3 深圳 阴 南山平山村 曾剑锋 ***********************************************************************************/ \\\\\\\\\\\\-*- 目录 -*-///////////// | 一、参考文章： | 二、JNI、HAL函数注册： | 三、Atheros GPS HAL初始化流程： ------------------------------------ 一、参考文章： GPS 研究二 （Android 2.3__gingerbread） http://blog.chinaunix.net/uid-25570748-id-184090.html android GPS HAL 回调函数实现 http://www.xuebuyuan.com/967335.html 二、JNI、HAL函数注册： cat /home/myzr/myandroid/frameworks/base/services/jni/com_android_server_location_GpsLocationProvider.cpp ... static void android_location_GpsLocationProvider_class_init_native(JNIEnv* env, jclass clazz) { int err; hw_module_t* module; method_reportLocation = env->GetMethodID(clazz, "reportLocation", "(IDDDFFFJ)V"); method_reportStatus = env->GetMethodID(clazz, "reportStatus", "(I)V"); method_reportSvStatus = env->GetMethodID(clazz, "reportSvStatus", "()V"); method_reportAGpsStatus = env->GetMethodID(clazz, "reportAGpsStatus", "(III)V"); method_reportNmea = env->GetMethodID(clazz, "reportNmea", "(J)V"); method_setEngineCapabilities = env->GetMethodID(clazz, "setEngineCapabilities", "(I)V"); method_xtraDownloadRequest = env->GetMethodID(clazz, "xtraDownloadRequest", "()V"); method_reportNiNotification = env->GetMethodID(clazz, "reportNiNotification", "(IIIIILjava/lang/String;Ljava/lang/String;IILjava/lang/String;)V"); method_requestRefLocation = env->GetMethodID(clazz,"requestRefLocation","(I)V"); method_requestSetID = env->GetMethodID(clazz,"requestSetID","(I)V"); method_requestUtcTime = env->GetMethodID(clazz,"requestUtcTime","()V"); err = hw_get_module(GPS_HARDWARE_MODULE_ID, (hw_module_t const**)&module); if (err == 0) { hw_device_t* device; <----------------------------------------+ err = module->methods->open(module, GPS_HARDWARE_MODULE_ID, &device); --------+ | if (err == 0) { | | gps_device_t* gps_device = (gps_device_t *)device; | | sGpsInterface = gps_device->get_gps_interface(gps_device); --------*-*-+ } | | | } | | | if (sGpsInterface) { | | | sGpsXtraInterface = | | | (const GpsXtraInterface*)sGpsInterface->get_extension(GPS_XTRA_INTERFACE); | | | sAGpsInterface = | | | (const AGpsInterface*)sGpsInterface->get_extension(AGPS_INTERFACE); | | | sGpsNiInterface = | | | (const GpsNiInterface*)sGpsInterface->get_extension(GPS_NI_INTERFACE); | | | sGpsDebugInterface = | | | (const GpsDebugInterface*)sGpsInterface->get_extension(GPS_DEBUG_INTERFACE);| | | sAGpsRilInterface = | | | (const AGpsRilInterface*)sGpsInterface->get_extension(AGPS_RIL_INTERFACE); | | | } | | | | } +-------+ | | | ... | | | | | | | | cat /home/myzr/myandroid/hardware/imx/libgps/gps.c | | | | ... | | | | extern const GpsInterface* gps_get_hardware_interface(); ---------+ | | | | const GpsInterface* gps__get_gps_interface(struct gps_device_t* dev) <--------*-*----*-*-+ { | | | | | return gps_get_hardware_interface(); ---------+ | | | | | | | | | } | | | | | | | | | | static int open_gps(const struct hw_module_t* module, char const* name, <---------------+ | | struct hw_device_t** device) | | | | | { | | | | | struct gps_device_t *dev = malloc(sizeof(struct gps_device_t)); ----------*-*----*-+ | memset(dev, 0, sizeof(*dev)); | | | | | | | | dev->common.tag = HARDWARE_DEVICE_TAG; | | | | dev->common.version = 0; | | | | dev->common.module = (struct hw_module_t*)module; | | | | dev->get_gps_interface = gps__get_gps_interface; <---------*-*----*---+ | | | *device = (struct hw_device_t*)dev; | | | return 0; | | | } | | | | | | static struct hw_module_methods_t gps_module_methods = { <----- + | | | .open = open_gps <------*---------------*-*----+ }; | | | | | | struct hw_module_t HAL_MODULE_INFO_SYM = { | | | .tag = HARDWARE_MODULE_TAG, | | | .version_major = 1, | | | .version_minor = 0, | | | .id = GPS_HARDWARE_MODULE_ID, | | | .name = "Atheros GPS Module", | | | .author = "FSL MAD, Inc.", | | | .methods = &gps_module_methods, ---------------+ | | }; | | ... | | | | cat /home/myzr/myandroid/hardware/imx/libgps/athr_gps.c | | ... | | #ifdef ATHR_GPSNi | | /* | | * Registers the callbacks for HAL to use | | */ | | static void athr_gps_ni_init(GpsNiCallbacks* callbacks) | | { | | GpsState* s = _gps_state; | | | | D("%s: entered", __FUNCTION__); | | | | if (callbacks) | | { | | s->ni_init = 1; | | s->ni_callbacks = *callbacks; | | } | | } | | | | /* | | * Sends a response to HAL | | */ | | static void athr_gps_ni_respond(int notif_id, GpsUserResponseType user_response) | | { | | // D("%s: entered", __FUNCTION__); | | } | | | | static const GpsNiInterface athrGpsNiInterface = { | | sizeof(GpsNiInterface), | | athr_gps_ni_init, | | athr_gps_ni_respond, | | }; | | #endif // ATHR_GPSNi | | | | | | /** | | * 10-30 06:19:30.190: D/athr_gps(2570): | | * athr_gps_get_extension: found xtra extension | | * 10-30 06:19:30.190: D/athr_gps(2570): | | * athr_gps_get_extension: no GPS extension for agps is found | | * 10-30 06:19:30.190: D/athr_gps(2570): | | * athr_gps_get_extension: found ni extension | | * 10-30 06:19:30.190: D/athr_gps(2570): | | * athr_gps_get_extension: no GPS extension for gps-debug is found | | * 10-30 06:19:30.190: D/athr_gps(2570): | | * athr_gps_get_extension: no GPS extension for agps_ril is foun | | */ | | static const void* athr_gps_get_extension(const char* name) <---------------*-+ { | | if (strcmp(name, GPS_XTRA_INTERFACE) == 0) | | { | | #ifdef ATHR_GPSXtra | | D("%s: found xtra extension", __FUNCTION__); | | return (&athrGpsXtraInterface); | | #endif // ATHR_GPSXtra | | } | | else if (strcmp(name, GPS_NI_INTERFACE) == 0) | | { | | #ifdef ATHR_GPSNi | | D("%s: found ni extension", __FUNCTION__); | | return (&athrGpsNiInterface); | | #endif // ATHR_GPSNi | | } | | D("%s: no GPS extension for %s is found", __FUNCTION__, name); | | return NULL; | | } | | | | static const GpsInterface athrGpsInterface = { <----+ | | .size =sizeof(GpsInterface), | | | .init = athr_gps_init, | | | .start = athr_gps_start, | | | .stop = athr_gps_stop, | | | .cleanup = athr_gps_cleanup, | | | .inject_time = athr_gps_inject_time, | | | .inject_location = athr_gps_inject_location, | | | .delete_aiding_data = athr_gps_delete_aiding_data, | | | .set_position_mode = athr_gps_set_position_mode, | | | .get_extension = athr_gps_get_extension, | | | }; | | | | | | const GpsInterface* gps_get_hardware_interface() | <-------------------+ | { | | return &athrGpsInterface; -----+ | } | ... | | | cat /home/myzr/myandroid/hardware/libhardware/include/hardware/gps.h | ... | /** | * Name for the GPS XTRA interface. | */ | #define GPS_XTRA_INTERFACE "gps-xtra" | | /** | * Name for the GPS DEBUG interface. | */ | #define GPS_DEBUG_INTERFACE "gps-debug" | | /** | * Name for the AGPS interface. | */ | #define AGPS_INTERFACE "agps" | | /** | * Name for NI interface | */ | #define GPS_NI_INTERFACE "gps-ni" | | /** | * Name for the AGPS-RIL interface. | */ | #define AGPS_RIL_INTERFACE "agps_ril" <------------------------+ ... 三、Atheros GPS HAL初始化流程： cat /home/myzr/myandroid/hardware/imx/libgps/athr_gps.c ...... typedef struct { int pos; int overflow; int utc_year; int utc_mon; int utc_day; int utc_diff; GpsLocation fix; GpsSvStatus sv_status; int sv_status_changed; char in[ NMEA_MAX_SIZE+1 ]; int gsa_fixed; AthTimemap_t timemap; } NmeaReader; <----+ | typedef struct { | int init; | int fd; | GpsCallbacks callbacks; | <--------+ pthread_t thread; | | pthread_t nmea_thread; | | pthread_t tmr_thread; | | int control[2]; | | int fix_freq; | | sem_t fix_sem; | | int first_fix; | | NmeaReader reader; ------+ | #ifdef ATHR_GPSXtra | int xtra_init; | GpsXtraCallbacks xtra_callbacks; | #endif | #ifdef ATHR_GPSNi | int ni_init; | GpsNiCallbacks ni_callbacks; | GpsNiNotification ni_notification; | #endif | } GpsState; --------------------+ | ...... | | static GpsState _gps_state[1]; <---+ <-----------+ | static GpsState *gps_state = _gps_state; <---+ | | ...... | | GpsCallbacks* g_gpscallback = 0; <-----------------------*-*-+ ...... | | | | | | static const GpsInterface athrGpsInterface = { | | | .size =sizeof(GpsInterface), | | | .init = athr_gps_init, -----------------+ | | | .start = athr_gps_start, | | | | .stop = athr_gps_stop, | | | | .cleanup = athr_gps_cleanup, | | | | .inject_time = athr_gps_inject_time, | | | | .inject_location = athr_gps_inject_location, | | | | .delete_aiding_data = athr_gps_delete_aiding_data, | | | | .set_position_mode = athr_gps_set_position_mode, | | | | .get_extension = athr_gps_get_extension, | | | | }; | | | | | | | | static int athr_gps_init(GpsCallbacks* callbacks) <------+ | | | { | | | GpsState* s = _gps_state; -------------+ | | | | D("gps state initializing %d",s->init); | | | | s->callbacks = *callbacks; -------------------------+ | if (!s->init) | gps_state_init(s); ----------+ | | | if(!g_gpscallback) | | g_gpscallback = callbacks; ----------*----------------+ | return 0; | } | | static void | gps_state_init( GpsState* state ) <---------+ { ... if ( socketpair( AF_LOCAL, SOCK_STREAM, 0, state->control ) < 0 ) { ALOGE("could not create thread control socket pair: %s", strerror(errno)); goto Fail; } state->thread = state->callbacks.create_thread_cb("athr_gps", gps_state_thread, state); if (!state->thread) | { | ALOGE("could not create gps thread: %s", strerror(errno)); | goto Fail; | } | state->callbacks.set_capabilities_cb(GPS_CAPABILITY_SCHEDULING); | D("gps state initialized"); | ... | } | | static void <-----------------------+ gps_state_thread( void* arg ) { ... state->tmr_thread = state->callbacks.create_thread_cb("athr_gps_tmr", gps_timer_thread, state); if (!state->tmr_thread) | { | ALOGE("could not create gps timer thread: %s", strerror(errno)); | started = 0; +--------------+ state->init = STATE_INIT; | goto Exit; | } | | state->nmea_thread = state->callbacks.create_thread_cb("athr_nmea_thread", gps_nmea_thread, | state); | | if (!state->nmea_thread) | | { | | ALOGE("could not create gps nmea thread: %s", strerror(errno)); | | started = 0; | | state->init = STATE_INIT; | | goto Exit; | | } | | ... | | } | | | | static void | | gps_nmea_thread( void* arg ) <-----------------+ | { | GpsState *state = (GpsState *)arg; <----+ | NmeaReader *reader; -----+ | | reader = &state->reader; -----+ -----+ | | | DFR("gps entered nmea thread"); | | int versioncnt = 0; | | | | // now loop +------------+ | while (continue_thread) | | { | | | | if (FD_ISSET(state->fd, &readfds)) | | { | | memset(buf,0,sizeof(buf)); | | ret = read( state->fd, buf, sizeof(buf) ); | | if (ret > 0) | | { | | if (strstr(buf, "CFG_R")) | | { | | ALOGI("ver %s",buf); | | } | | | | for (nn = 0; nn < ret; nn++) | | nmea_reader_addc( reader, buf[nn] ); <---+ -----------+ | | | /* ATHR in/out sentences*/ | | if ((buf[0] == 'O') && (buf[1] == 'A') && (buf[2] == 'P')) { | | D("OAP200 sentences found"); | | athr_reader_parse(buf, ret); | | /* | | for (nn = 0; nn < ret; nn++) | | D("%.2x ", buf[nn]); | | */ | | }else if ((buf[0] == '#') && (buf[1] == '!') && \ | | (buf[2] == 'G') && (buf[3] == 'S') && \ | | (buf[4] == 'M') && (buf[5] == 'A')) { | | D("GSMA sentences found"); | | athr_reader_parse(buf, ret); | | } | | } | | else | | { | | DFR("Error on NMEA read :%s",strerror(errno)); | | gps_closetty(state); | | GPS_STATUS_CB(state->callbacks, GPS_STATUS_SESSION_END); | | sleep(3); //wait Orion shutdown. | | bOrionShutdown = 1; | | continue; | | } | | } | | | | if(!continue_thread) | | break; | | } | | Exit: | | DFR("gps nmea thread destroyed"); | | return; | | } | | | | static void | | nmea_reader_addc( NmeaReader* r, int c ) <--------------------+ | { | int cnt; | | if (r->overflow) { | r->overflow = (c != '\n'); | return; | } | | if (r->pos >= (int) sizeof(r->in)-1 ) { | r->overflow = 1; | r->pos = 0; | return; | } | | r->in[r->pos] = (char)c; | r->pos += 1; | | if (c == '\n') { | gps_state_lock_fix(gps_state); | nmea_reader_parse( r ); --------+ | gps_state_unlock_fix(gps_state); | | r->pos = 0; | | } | | } | | | | static void | | nmea_reader_parse( NmeaReader* r ) <-------+ | { | /* we received a complete sentence, now parse it to generate | * a new GPS fix... | */ | NmeaTokenizer tzer[1]; | Token tok; | | if (r->pos < 9) { | return; | } | | if (gps_state->callbacks.nmea_cb) { | struct timeval tv; | unsigned long long mytimems; | gettimeofday(&tv,NULL); | mytimems = tv.tv_sec * 1000 + tv.tv_usec / 1000; | gps_state->callbacks.nmea_cb(mytimems, r->in, r->pos); | } | | nmea_tokenizer_init(tzer, r->in, r->in + r->pos); | #ifdef GPS_DEBUG_TOKEN | { | int n; | D("Found %d tokens", tzer->count); | for (n = 0; n < tzer->count; n++) { | Token tok = nmea_tokenizer_get(tzer,n); | D("%2d: '%.*s'", n, tok.end-tok.p, tok.p); | } | } | #endif | | tok = nmea_tokenizer_get(tzer, 0); | | if (tok.p + 5 > tok.end) { | /* for $PUNV sentences */ | if ( !memcmp(tok.p, "PUNV", 4) ) { | Token tok_cfg = nmea_tokenizer_get(tzer,1); | | if (!memcmp(tok_cfg.p, "CFG_R", 5)) { | } else if ( !memcmp(tok_cfg.p, "QUAL", 4) ) { | Token tok_sigma_x = nmea_tokenizer_get(tzer, 3); | | if (tok_sigma_x.p[0] != ',') { | Token tok_accuracy = nmea_tokenizer_get(tzer, 10); | nmea_reader_update_accuracy(r, tok_accuracy); | } | } else if (!memcmp(tok_cfg.p, "TIMEMAP", 7)) | { | Token systime = nmea_tokenizer_get(tzer, 8); // system time token | Token timestamp = nmea_tokenizer_get(tzer, 2); // UTC time token | nmea_reader_update_timemap(r, systime, timestamp); | } | }else{ | } | return; | } | | if ( !memcmp(tok.p, "GPG", 3) ) //GPGSA,GPGGA,GPGSV | bGetFormalNMEA = 1; | // ignore first two characters. | tok.p += 2; | | if ( !memcmp(tok.p, "GGA", 3) ) { | // GPS fix | Token tok_fixstaus = nmea_tokenizer_get(tzer,6); | | if (tok_fixstaus.p[0] > '0') { | | Token tok_time = nmea_tokenizer_get(tzer,1); | Token tok_latitude = nmea_tokenizer_get(tzer,2); | Token tok_latitudeHemi = nmea_tokenizer_get(tzer,3); | Token tok_longitude = nmea_tokenizer_get(tzer,4); | Token tok_longitudeHemi = nmea_tokenizer_get(tzer,5); | Token tok_altitude = nmea_tokenizer_get(tzer,9); | Token tok_altitudeUnits = nmea_tokenizer_get(tzer,10); | | nmea_reader_update_time(r, tok_time); | nmea_reader_update_latlong(r, tok_latitude, | tok_latitudeHemi.p[0], | tok_longitude, | tok_longitudeHemi.p[0]); | nmea_reader_update_altitude(r, tok_altitude, tok_altitudeUnits); | } | | } else if ( !memcmp(tok.p, "GLL", 3) ) { | | Token tok_fixstaus = nmea_tokenizer_get(tzer,6); | | if (tok_fixstaus.p[0] == 'A') { | | Token tok_latitude = nmea_tokenizer_get(tzer,1); | Token tok_latitudeHemi = nmea_tokenizer_get(tzer,2); | Token tok_longitude = nmea_tokenizer_get(tzer,3); | Token tok_longitudeHemi = nmea_tokenizer_get(tzer,4); | Token tok_time = nmea_tokenizer_get(tzer,5); | | nmea_reader_update_time(r, tok_time); | nmea_reader_update_latlong(r, tok_latitude, | tok_latitudeHemi.p[0], | tok_longitude, | tok_longitudeHemi.p[0]); | } | } else if ( !memcmp(tok.p, "GSA", 3) ) { | | Token tok_fixStatus = nmea_tokenizer_get(tzer, 2); | int i; | | if (tok_fixStatus.p[0] != '\0' && tok_fixStatus.p[0] != '1') { | | r->sv_status.used_in_fix_mask = 0ul; | | for (i = 3; i <= 14; ++i){ | | Token tok_prn = nmea_tokenizer_get(tzer, i); | int prn = str2int(tok_prn.p, tok_prn.end); | | /* only available for PRN 1-32 */ | if ((prn > 0) && (prn < 33)){ | r->sv_status.used_in_fix_mask |= (1ul << (prn-1)); | r->sv_status_changed = 1; | /* mark this parameter to identify the GSA is in fixed state */ | r->gsa_fixed = 1; | } | } | | }else { | if (r->gsa_fixed == 1) { | r->sv_status.used_in_fix_mask = 0ul; | r->sv_status_changed = 1; | r->gsa_fixed = 0; | } | } | D("%s","zengjf GSA"); | } else if ( !memcmp(tok.p, "GSV", 3) ) { | | Token tok_noSatellites = nmea_tokenizer_get(tzer, 3); | int noSatellites = str2int(tok_noSatellites.p, tok_noSatellites.end); | | if (noSatellites > 0) { | | Token tok_noSentences = nmea_tokenizer_get(tzer, 1); | Token tok_sentence = nmea_tokenizer_get(tzer, 2); | | int sentence = str2int(tok_sentence.p, tok_sentence.end); | int totalSentences = str2int(tok_noSentences.p, tok_noSentences.end); | int curr; | int i; | | if (sentence == 1) { | r->sv_status_changed = 0; | r->sv_status.num_svs = 0; | } | | curr = r->sv_status.num_svs; | | i = 0; | | while (i < 4 && r->sv_status.num_svs < noSatellites){ | | Token tok_prn = nmea_tokenizer_get(tzer, i * 4 + 4); | Token tok_elevation = nmea_tokenizer_get(tzer, i * 4 + 5); | Token tok_azimuth = nmea_tokenizer_get(tzer, i * 4 + 6); | Token tok_snr = nmea_tokenizer_get(tzer, i * 4 + 7); | | r->sv_status.sv_list[curr].prn = str2int(tok_prn.p, tok_prn.end); | r->sv_status.sv_list[curr].elevation = | str2float(tok_elevation.p, tok_elevation.end); | r->sv_status.sv_list[curr].azimuth = | str2float(tok_azimuth.p, tok_azimuth.end); | r->sv_status.sv_list[curr].snr = str2float(tok_snr.p, tok_snr.end); | | r->sv_status.num_svs += 1; | | curr += 1; | | i += 1; | } | | if (sentence == totalSentences) { | r->sv_status_changed = 1; | } | } | | } else if ( !memcmp(tok.p, "RMC", 3) ) | | Token tok_fixStatus = nmea_tokenizer_get(tzer,2); | | if (tok_fixStatus.p[0] == 'A') | { | Token tok_time = nmea_tokenizer_get(tzer,1); | Token tok_latitude = nmea_tokenizer_get(tzer,3); | Token tok_latitudeHemi = nmea_tokenizer_get(tzer,4); | Token tok_longitude = nmea_tokenizer_get(tzer,5); | Token tok_longitudeHemi = nmea_tokenizer_get(tzer,6); | Token tok_speed = nmea_tokenizer_get(tzer,7); | Token tok_bearing = nmea_tokenizer_get(tzer,8); | Token tok_date = nmea_tokenizer_get(tzer,9); | | nmea_reader_update_date( r, tok_date, tok_time ); | | nmea_reader_update_latlong( r, tok_latitude, | tok_latitudeHemi.p[0], | tok_longitude, | tok_longitudeHemi.p[0] ); | | nmea_reader_update_bearing( r, tok_bearing ); | nmea_reader_update_speed ( r, tok_speed ); | } | D("%s","zengjf RMC"); | | } else if ( !memcmp(tok.p, "VTG", 3) ) { | | Token tok_fixStatus = nmea_tokenizer_get(tzer,9); | | if (tok_fixStatus.p[0] != '\0' && tok_fixStatus.p[0] != 'N') | { | Token tok_bearing = nmea_tokenizer_get(tzer,1); | Token tok_speed = nmea_tokenizer_get(tzer,5); | | nmea_reader_update_bearing( r, tok_bearing ); | nmea_reader_update_speed ( r, tok_speed ); | } | | } else if ( !memcmp(tok.p, "ZDA", 3) ) { | | Token tok_time; | Token tok_year = nmea_tokenizer_get(tzer,4); | | if (tok_year.p[0] != '\0') { | | Token tok_day = nmea_tokenizer_get(tzer,2); | Token tok_mon = nmea_tokenizer_get(tzer,3); | | nmea_reader_update_cdate( r, tok_day, tok_mon, tok_year ); | | } | | tok_time = nmea_tokenizer_get(tzer,1); | | if (tok_time.p[0] != '\0') { | | nmea_reader_update_time(r, tok_time); | | } | | | } else { | tok.p -= 2; | } | | if (!gps_state->first_fix && | gps_state->init == STATE_INIT && | r->fix.flags & GPS_LOCATION_HAS_LAT_LONG) { | | ath_send_ni_notification(r); | | if (gps_state->callbacks.location_cb) { | gps_state->callbacks.location_cb( &r->fix ); | r->fix.flags = 0; | } | | gps_state->first_fix = 1; | } | } | | static void | gps_timer_thread( void* arg ) <----------------------------------+ { int need_sleep = 0; int sleep_val = 0; GpsState *state = (GpsState *)arg; DFR("gps entered timer thread"); do { while(started != 1 && continue_thread) // { usleep(500*1000); } gps_state_lock_fix(state); if ((state->reader.fix.flags & GPS_LOCATION_HAS_LAT_LONG) != 0) { //D("gps fix cb: 0x%x", state->reader.fix.flags); if (state->callbacks.location_cb) { state->callbacks.location_cb( &state->reader.fix ); state->reader.fix.flags = 0; state->first_fix = 1; } if (state->fix_freq == 0) { state->fix_freq = -1; } } if (state->reader.sv_status_changed != 0) { // D("gps sv status callback"); if (state->callbacks.sv_status_cb) { state->callbacks.sv_status_cb( &state->reader.sv_status ); state->reader.sv_status_changed = 0; } } need_sleep = (state->fix_freq != -1 && (state->init != STATE_QUIT) ? 1 : 0) ; sleep_val = state->fix_freq; gps_state_unlock_fix(state); if (need_sleep) { sleep(sleep_val); } else { D("won't sleep because fix_freq=%d state->init=%d",state->fix_freq, sta te->init); } ath_send_ni_notification(&state->reader); if( state->init == STATE_INIT && lastcmd == CMD_STOP && started == 1) { int gap = 0; D("Wait for NMEA coming,%d,%d,%d", state->init , lastcmd, started); while (state->init != STATE_START && bGetFormalNMEA == 0 && continue_th read && !bOrionShutdown) { usleep(300*1000); if (++gap > 100) break; } ; D("Get NMEA %d and state %d",bGetFormalNMEA,state->init); // even we don't get nmea after 30 second, still force close it bGetFormalNMEA |= (gap >= 100); if( state->init == STATE_INIT && lastcmd == CMD_STOP && started == 1) { gps_sleep(state); } else { D("User enter LM before sending sleep, so drop it"); } } } while(continue_thread); DFR("gps timer thread destroyed"); return; }
