| /* Copyright (c) 2011 Code Aurora Forum. All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions are |
| * met: |
| * * Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * * Redistributions in binary form must reproduce the above |
| * copyright notice, this list of conditions and the following |
| * disclaimer in the documentation and/or other materials provided |
| * with the distribution. |
| * * Neither the name of Code Aurora Forum, Inc. nor the names of its |
| * contributors may be used to endorse or promote products derived |
| * from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED |
| * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF |
| * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT |
| * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS |
| * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR |
| * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, |
| * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE |
| * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN |
| * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| * |
| */ |
| |
| #define LOG_NDDEBUG 0 |
| #define LOG_TAG "LocSvc_utils_cfg" |
| |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <pthread.h> |
| #include <string.h> |
| #include <ctype.h> |
| #include <unistd.h> |
| #include <time.h> |
| #include <loc_cfg.h> |
| #include <log_util.h> |
| |
| /*============================================================================= |
| * |
| * GLOBAL DATA DECLARATION |
| * |
| *============================================================================*/ |
| |
| /* Parameter data */ |
| loc_gps_cfg_s_type gps_conf; |
| |
| /* Parameter spec table */ |
| |
| loc_param_s_type loc_parameter_table[] = |
| { |
| {"INTERMEDIATE_POS", &gps_conf.INTERMEDIATE_POS, 'n'}, |
| {"ACCURACY_THRES", &gps_conf.ACCURACY_THRES, 'n'}, |
| {"ENABLE_WIPER", &gps_conf.ENABLE_WIPER, 'n'}, |
| /* DEBUG LEVELS: 0 - none, 1 - Error, 2 - Warning, 3 - Info |
| 4 - Debug, 5 - Verbose */ |
| {"DEBUG_LEVEL", &gps_conf.DEBUG_LEVEL, 'n'}, |
| {"SUPL_VER", &gps_conf.SUPL_VER, 'n'}, |
| {"CAPABILITIES", &gps_conf.CAPABILITIES, 'n'}, |
| {"TIMESTAMP", &gps_conf.TIMESTAMP, 'n'}, |
| {"GYRO_BIAS_RANDOM_WALK", &gps_conf.GYRO_BIAS_RANDOM_WALK, 'f'}, |
| {"SENSOR_ACCEL_BATCHES_PER_SEC", &gps_conf.SENSOR_ACCEL_BATCHES_PER_SEC, 'n'}, |
| {"SENSOR_ACCEL_SAMPLES_PER_BATCH", &gps_conf.SENSOR_ACCEL_SAMPLES_PER_BATCH, 'n'}, |
| {"SENSOR_GYRO_BATCHES_PER_SEC", &gps_conf.SENSOR_GYRO_BATCHES_PER_SEC, 'n'}, |
| {"SENSOR_GYRO_SAMPLES_PER_BATCH", &gps_conf.SENSOR_GYRO_SAMPLES_PER_BATCH, 'n'}, |
| {"SENSOR_CONTROL_MODE", &gps_conf.SENSOR_CONTROL_MODE, 'n'}, |
| {"SENSOR_USAGE", &gps_conf.SENSOR_USAGE, 'n'}, |
| }; |
| |
| int loc_param_num = sizeof(loc_parameter_table) / sizeof(loc_param_s_type); |
| |
| /*=========================================================================== |
| FUNCTION loc_default_parameters |
| |
| DESCRIPTION |
| Resets the parameters to default |
| |
| DEPENDENCIES |
| N/A |
| |
| RETURN VALUE |
| None |
| |
| SIDE EFFECTS |
| N/A |
| ===========================================================================*/ |
| |
| static void loc_default_parameters() |
| { |
| /* defaults */ |
| gps_conf.INTERMEDIATE_POS = 0; |
| gps_conf.ACCURACY_THRES = 0; |
| gps_conf.ENABLE_WIPER = 0; |
| gps_conf.DEBUG_LEVEL = 3; /* debug level */ |
| gps_conf.SUPL_VER = 0x10000; |
| gps_conf.CAPABILITIES = 0x7; |
| gps_conf.TIMESTAMP = 0; |
| |
| gps_conf.GYRO_BIAS_RANDOM_WALK = 0; |
| |
| gps_conf.SENSOR_ACCEL_BATCHES_PER_SEC = 2; |
| gps_conf.SENSOR_ACCEL_SAMPLES_PER_BATCH = 5; |
| gps_conf.SENSOR_GYRO_BATCHES_PER_SEC = 2; |
| gps_conf.SENSOR_GYRO_SAMPLES_PER_BATCH = 5; |
| gps_conf.SENSOR_CONTROL_MODE = 0; /* AUTO */ |
| gps_conf.SENSOR_USAGE = 0; /* Enabled */ |
| |
| /* Value MUST be set by OEMs in configuration for sensor-assisted |
| navigation to work. There is NO default value */ |
| gps_conf.GYRO_BIAS_RANDOM_WALK_VALID = 0; |
| |
| /* reset logging mechanism */ |
| loc_logger_init(gps_conf.DEBUG_LEVEL, 0); |
| } |
| |
| /*=========================================================================== |
| FUNCTION trim_space |
| |
| DESCRIPTION |
| Removes leading and trailing spaces of the string |
| |
| DEPENDENCIES |
| N/A |
| |
| RETURN VALUE |
| None |
| |
| SIDE EFFECTS |
| N/A |
| ===========================================================================*/ |
| void trim_space(char *org_string) |
| { |
| char *scan_ptr, *write_ptr; |
| char *first_nonspace = NULL, *last_nonspace = NULL; |
| |
| scan_ptr = write_ptr = org_string; |
| |
| while (*scan_ptr) |
| { |
| if ( !isspace(*scan_ptr) && first_nonspace == NULL) |
| { |
| first_nonspace = scan_ptr; |
| } |
| |
| if (first_nonspace != NULL) |
| { |
| *(write_ptr++) = *scan_ptr; |
| if ( !isspace(*scan_ptr)) |
| { |
| last_nonspace = write_ptr; |
| } |
| } |
| |
| scan_ptr++; |
| } |
| |
| if (last_nonspace) { *last_nonspace = '\0'; } |
| } |
| |
| /*=========================================================================== |
| FUNCTION loc_read_gps_conf |
| |
| DESCRIPTION |
| Reads the gps.conf file and sets global parameter data |
| |
| DEPENDENCIES |
| N/A |
| |
| RETURN VALUE |
| None |
| |
| SIDE EFFECTS |
| N/A |
| ===========================================================================*/ |
| void loc_read_gps_conf(void) |
| { |
| FILE *gps_conf_fp = NULL; |
| char input_buf[LOC_MAX_PARAM_LINE]; /* declare a char array */ |
| char *lasts; |
| char *param_name, *param_str_value; |
| int param_int_value = 0; |
| double param_double_value = 0; |
| int i; |
| |
| loc_default_parameters(); |
| |
| if((gps_conf_fp = fopen(GPS_CONF_FILE, "r")) != NULL) |
| { |
| LOC_LOGD("%s: using %s", __FUNCTION__, GPS_CONF_FILE); |
| } |
| else |
| { |
| LOC_LOGW("%s: no %s file, using defaults", __FUNCTION__, GPS_CONF_FILE); |
| return; /* no parameter file */ |
| } |
| |
| while(fgets(input_buf, LOC_MAX_PARAM_LINE, gps_conf_fp) != NULL) |
| { |
| /* Separate variable and value */ |
| param_name = strtok_r(input_buf, "=", &lasts); |
| if (param_name == NULL) continue; /* skip lines that do not contain "=" */ |
| param_str_value = strtok_r(NULL, "=", &lasts); |
| if (param_str_value == NULL) continue; /* skip lines that do not contain two operands */ |
| |
| /* Trim leading and trailing spaces */ |
| trim_space(param_name); |
| trim_space(param_str_value); |
| |
| // printf("*(%s) = (%s)\n", param_name, param_str_value); |
| |
| /* Parse numerical value */ |
| if (param_str_value[0] == '0' && tolower(param_str_value[1]) == 'x') |
| { |
| /* hex */ |
| param_int_value = (int) strtol(¶m_str_value[2], (char**) NULL, 16); |
| } |
| else { |
| param_double_value = (double) atof(param_str_value); /* float */ |
| param_int_value = atoi(param_str_value); /* dec */ |
| } |
| |
| if (strcmp("GYRO_BIAS_RANDOM_WALK", param_name) == 0) |
| { |
| gps_conf.GYRO_BIAS_RANDOM_WALK_VALID = 1; |
| } |
| |
| for(i = 0; i < loc_param_num; i++) |
| { |
| if (strcmp(loc_parameter_table[i].param_name, param_name) == 0 && |
| loc_parameter_table[i].param_ptr) |
| { |
| switch (loc_parameter_table[i].param_type) |
| { |
| case 's': |
| if (strcmp(param_str_value, "NULL") == 0) |
| { |
| *((char*)loc_parameter_table[i].param_ptr) = '\0'; |
| } |
| else { |
| strlcpy((char*) loc_parameter_table[i].param_ptr, |
| param_str_value, |
| LOC_MAX_PARAM_STRING + 1); |
| } |
| /* Log INI values */ |
| LOC_LOGD("%s: PARAM %s = %s", __FUNCTION__, param_name, (char*)loc_parameter_table[i].param_ptr); |
| break; |
| case 'n': |
| *((int *)loc_parameter_table[i].param_ptr) = param_int_value; |
| /* Log INI values */ |
| LOC_LOGD("%s: PARAM %s = %d", __FUNCTION__, param_name, param_int_value); |
| break; |
| case 'f': |
| *((double *)loc_parameter_table[i].param_ptr) = param_double_value; |
| /* Log INI values */ |
| LOC_LOGD("%s: PARAM %s = %f", __FUNCTION__, param_name, param_double_value); |
| break; |
| default: |
| LOC_LOGE("%s: PARAM %s parameter type must be n or n", __FUNCTION__, param_name); |
| } |
| } |
| } |
| } |
| |
| fclose(gps_conf_fp); |
| |
| /* Initialize logging mechanism with parsed data */ |
| loc_logger_init(gps_conf.DEBUG_LEVEL, gps_conf.TIMESTAMP); |
| } |