device_xiaomi_sm6150-common/gps/utils/loc_misc_utils.cpp

/* Copyright (c) 2014, 2020 The Linux Foundation. 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 The Linux Foundation, 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_NDEBUG 0
#define LOG_TAG "LocSvc_misc_utils"
#include <stdio.h>
#include <string.h>
#include <inttypes.h>
#include <dlfcn.h>
#include <log_util.h>
#include <loc_misc_utils.h>
#include <ctype.h>
#include <fcntl.h>
#include <inttypes.h>

#ifndef MSEC_IN_ONE_SEC
#define MSEC_IN_ONE_SEC 1000ULL
#endif
#define GET_MSEC_FROM_TS(ts) ((ts.tv_sec * MSEC_IN_ONE_SEC) + (ts.tv_nsec + 500000)/1000000)

int loc_util_split_string(char *raw_string, char **split_strings_ptr,
                          int max_num_substrings, char delimiter)
{
    int raw_string_index=0;
    int num_split_strings=0;
    unsigned char end_string=0;
    int raw_string_length=0;

    if(!raw_string || !split_strings_ptr) {
        LOC_LOGE("%s:%d]: NULL parameters", __func__, __LINE__);
        num_split_strings = -1;
        goto err;
    }
    LOC_LOGD("%s:%d]: raw string: %s\n", __func__, __LINE__, raw_string);
    raw_string_length = strlen(raw_string) + 1;
    split_strings_ptr[num_split_strings] = &raw_string[raw_string_index];
    for(raw_string_index=0; raw_string_index < raw_string_length; raw_string_index++) {
        if(raw_string[raw_string_index] == '\0')
            end_string=1;
        if((raw_string[raw_string_index] == delimiter) || end_string) {
            raw_string[raw_string_index] = '\0';
            if (num_split_strings < max_num_substrings) {
                LOC_LOGD("%s:%d]: split string: %s\n",
                         __func__, __LINE__, split_strings_ptr[num_split_strings]);
            }
            num_split_strings++;
            if(((raw_string_index + 1) < raw_string_length) &&
               (num_split_strings < max_num_substrings)) {
                split_strings_ptr[num_split_strings] = &raw_string[raw_string_index+1];
            }
            else {
                break;
            }
        }
        if(end_string)
            break;
    }
err:
    LOC_LOGD("%s:%d]: num_split_strings: %d\n", __func__, __LINE__, num_split_strings);
    return num_split_strings;
}

void loc_util_trim_space(char *org_string)
{
    char *scan_ptr, *write_ptr;
    char *first_nonspace = NULL, *last_nonspace = NULL;

    if(org_string == NULL) {
        LOC_LOGE("%s:%d]: NULL parameter", __func__, __LINE__);
        goto err;
    }

    scan_ptr = write_ptr = org_string;

    while (*scan_ptr) {
        //Find the first non-space character
        if ( !isspace(*scan_ptr) && first_nonspace == NULL) {
            first_nonspace = scan_ptr;
        }
        //Once the first non-space character is found in the
        //above check, keep shifting the characters to the left
        //to replace the spaces
        if (first_nonspace != NULL) {
            *(write_ptr++) = *scan_ptr;
            //Keep track of which was the last non-space character
            //encountered
            //last_nonspace will not be updated in the case where
            //the string ends with spaces
            if ( !isspace(*scan_ptr)) {
                last_nonspace = write_ptr;
            }
        }
        scan_ptr++;
    }
    //Add NULL terminator after the last non-space character
    if (last_nonspace) { *last_nonspace = '\0'; }
err:
    return;
}

inline void logDlError(const char* failedCall) {
    const char * err = dlerror();
    LOC_LOGe("%s error: %s", failedCall, (nullptr == err) ? "unknown" : err);
}

void* dlGetSymFromLib(void*& libHandle, const char* libName, const char* symName)
{
    void* sym = nullptr;
    if ((nullptr != libHandle || nullptr != libName) && nullptr != symName) {
        if (nullptr == libHandle) {
            libHandle = dlopen(libName, RTLD_NOW);
            if (nullptr == libHandle) {
                logDlError("dlopen");
            }
        }
        // NOT else, as libHandle gets assigned 5 line above
        if (nullptr != libHandle) {
            sym = dlsym(libHandle, symName);
            if (nullptr == sym) {
                logDlError("dlsym");
            }
        }
    } else {
        LOC_LOGe("Either libHandle (%p) or libName (%p) must not be null; "
                 "symName (%p) can not be null.", libHandle, libName, symName);
    }

    return sym;
}

uint64_t getQTimerTickCount()
{
    uint64_t qTimerCount = 0;
#if __aarch64__
    asm volatile("mrs %0, cntvct_el0" : "=r" (qTimerCount));
#elif defined (__i386__) || defined (__x86_64__)
    /* Qtimer not supported in x86 architecture */
    qTimerCount = 0;
#else
    asm volatile("mrrc p15, 1, %Q0, %R0, c14" : "=r" (qTimerCount));
#endif

    return qTimerCount;
}

uint64_t getQTimerDeltaNanos()
{
    char qtimer_val_string[100];
    char *temp;
    uint64_t local_qtimer = 0, remote_qtimer = 0;
    int mdm_fd = -1, wlan_fd = -1, ret = 0;
    uint64_t delta = 0;

    memset(qtimer_val_string, '\0', sizeof(qtimer_val_string));

    char devNode[] = "/sys/bus/mhi/devices/0306_00.01.00/time_us";
    for (; devNode[27] < 3 && mdm_fd < 0; devNode[27]++) {
        mdm_fd = ::open(devNode, O_RDONLY);
        if (mdm_fd < 0) {
            LOC_LOGe("MDM open file: %s error: %s", devNode, strerror(errno));
        }
    }
    if (mdm_fd > 0) {
        ret = read(mdm_fd, qtimer_val_string, sizeof(qtimer_val_string)-1);
        ::close(mdm_fd);
        if (ret < 0) {
            LOC_LOGe("MDM read time_us file error: %s", strerror(errno));
        } else {
            temp = qtimer_val_string;
            temp = strchr(temp, ':');
            temp = temp + 2;
            local_qtimer = atoll(temp);

            temp = strchr(temp, ':');
            temp = temp + 2;
            remote_qtimer = atoll(temp);

            if (local_qtimer >= remote_qtimer) {
                delta = (local_qtimer - remote_qtimer) * 1000;
            }
            LOC_LOGv("qtimer values in microseconds: local:%" PRIi64 " remote:%" PRIi64 ""
                     " delta in nanoseconds:%" PRIi64 "",
                     local_qtimer, remote_qtimer, delta);
        }
    }
    return delta;
}

uint64_t getQTimerFreq()
{
#if __aarch64__
    uint64_t val = 0;
    asm volatile("mrs %0, cntfrq_el0" : "=r" (val));
#elif defined (__i386__) || defined (__x86_64__)
    /* Qtimer not supported in x86 architecture */
    uint64_t val = 0;
#else
    uint32_t val = 0;
    asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (val));
#endif
    return val;
}

uint64_t getBootTimeMilliSec()
{
    struct timespec curTs;
    clock_gettime(CLOCK_BOOTTIME, &curTs);
    return (uint64_t)GET_MSEC_FROM_TS(curTs);
}