mbtk/test/liblynq_lib/qser_gnss_test.c

#include <stdio.h>
#include <string.h>
#include <strings.h>
#include <stdlib.h>
#include <errno.h>
#include <termios.h>
#include <unistd.h>
#include <fcntl.h>
#include <signal.h>
#include <sys/types.h>
#include <unistd.h>
#include <pthread.h>
#include <termios.h>
#include <time.h>
#include <sys/ioctl.h>
#include <dlfcn.h>
#include <stdint.h>
#include "lynq_gnss.h"

void cb(uint32_t h_loc, e_msg_id_t e_msg_id, void *pv_data, void *context_ptr)
{
    printf("e_msg_id=%d\n", e_msg_id);
    switch(e_msg_id)
    {
    case E_MT_LOC_MSG_ID_LOCATION_INFO:				//选择mode1，输出定位信息
    {
        mopen_location_info_t *pt_location = (mopen_location_info_t *)pv_data;
        printf("**** flag=0x%X, Latitude = %f, Longitude=%f, altitude = %f, speed = %f, timestamp = %lld ****\n",
               pt_location->flags,
               pt_location->latitude,
               pt_location->longitude,
               pt_location->altitude,
               pt_location->speed,
               pt_location->timestamp);
        break;
    }
    case E_MT_LOC_MSG_ID_NMEA_INFO:				//选择mode3，输出nmea数据信息
    {
        mopen_gnss_nmea_info_t  *pt_nmea = (mopen_gnss_nmea_info_t *)pv_data;

        printf("**** NMEA info: timestamp=%lld, length=%d, nmea=%s ****\n",
               pt_nmea->timestamp, pt_nmea->length, pt_nmea->nmea);
        break;
    }
    }
}

void async_cb(qser_gnss_error_e state)
{
    printf("start gnss async state: %d \n", state);
}

void user_help(void)
{
    printf("\t-1 exit\n"
           "\t1 gnss init\n"
           "\t2 gnss deinit \n"
           "\t3 gnss add handle function\n"
           "\t4 gnss set single mode\n"
           "\t5 gnss set get_para_from_nmea mode\n"
           "\t6 gnss start\n"
           "\t7 gnss stop\n"
           /*
           "\t8 gnss Delete_Aiding_Data and reset\n"
           "\t9 gnss injecttime\n"
           "\t10 gnss download agps\n"
           "\t11 gnss set frequency\n"
           "\t12 gnss send agps data to 5311\n"
           "\t13 gnss config agps server info\n"
           "\t14 gnss set async cb\n"
           "\t15 gnss start async\n"
           */
           "please input operator: >> \n");
}
void delete_type(void)
{
    printf("\t0 DELETE_NOTHING\n"
           "\t1 DELETE_EPHEMERIS\n"
           "\t2 DELETE_ALMANAC\n"
           "\t3 DELETE_POSITION_TIME \n"
           "\t4 DELETE_UTC\n"
           "\t5 DELETE_ALL\n"
           "please input operator: >> \n");
}

int main(int argc, char *argv[])
{
    int ret;
    int opt = 0;
    //char *lynqLib_gnss = "/lib/liblynq-qser-gnss.so";
    char dev_file[12] = {0};
    uint32_t ph_gnss;
    //dlHandle_gnss = dlopen(lynqLib_gnss, RTLD_NOW);
    while(1)
    {
        printf("=========gnss main=========\n");
        user_help();
        scanf("%d", &opt);
        switch (opt)
        {
        case -1:
        {
            printf("main exit\n");
            return 0;
        }

        case 1:
        {
            //qser_Gnss_Init=(int(*)(uint32_t *h_gnss))dlsym(dlHandle_gnss, "qser_Gnss_Init");
            ret = qser_Gnss_Init(&ph_gnss);
            if(ret < 0)
            {
                printf("mopen_gnss_client_init FAIL.\n");
                return -1;
            }
            printf("mopen_gnss_client_init success , with address=%d\n",  ph_gnss);
            break;
        }
        case 2:
        {
            //qser_Gnss_Deinit=(int(*)(uint32_t))dlsym(dlHandle_gnss, "qser_Gnss_Deinit");
            ret =qser_Gnss_Deinit(ph_gnss);
            if(ret < 0)
            {
                printf("mopen_gnss_client_Deinit FAIL.\n");
                return -1;
            }
            printf("mopen_gnss_client_Deinit success \n");
            break;
        }
        case 3:
        {
            //qser_AddRxIndMsgHandler=(int(*)(gnss_handler_func_t,uint32_t))dlsym(dlHandle_gnss, "qser_AddRxIndMsgHandler");
            ret = qser_AddRxIndMsgHandler((gnss_handler_func_t)&cb,ph_gnss);
            if(ret < 0)
            {
                printf("lynq_AddRxIndMsgHandler fail\n");
                qser_Gnss_Deinit(ph_gnss);
                return -1;
            }
            printf("add success\n");
            break;
        }
        case 4:
        {
            e_msg_id_t ptr2=E_MT_LOC_MSG_ID_LOCATION_INFO;
            //qser_Set_Indications=(int(*)(uint32_t h_gnss,e_msg_id_t))dlsym(dlHandle_gnss, "qser_Set_Indications");
            ret = qser_Set_Indications(ph_gnss,ptr2);
            if(ret < 0)
            {
                printf("lynq_Set_LOCATION_INFO fail\n");
                qser_Gnss_Deinit(ph_gnss);
                return -1;
            }
            printf("set location mode success\n");
            break;
        }
        case 5:
        {
            e_msg_id_t ptr4=E_MT_LOC_MSG_ID_NMEA_INFO;
            //qser_Set_Indications=(int(*)(uint32_t h_gnss,e_msg_id_t))dlsym(dlHandle_gnss, "qser_Set_Indications");
            ret = qser_Set_Indications(ph_gnss,ptr4);
            if(ret < 0)
            {
                printf("lynq_Set_NMEA_INFO fail\n");
                qser_Gnss_Deinit(ph_gnss);
                return -1;
            }
            printf("set nmea mode success\n");
            break;
            
        }
        case 6:
        {
            //qser_Gnss_Start=(int(*)(uint32_t))dlsym(dlHandle_gnss, "qser_Gnss_Start");
            ret = qser_Gnss_Start(ph_gnss);
            if(ret < 0)
            {
                printf("lynq_Gnss_Start fail\n");
                return -1;
            }
            printf("start success\n");
            break;
        }
        case 7:
        {
            //qser_Gnss_Stop=(int(*)(uint32_t))dlsym(dlHandle_gnss, "qser_Gnss_Stop");
            ret = qser_Gnss_Stop(ph_gnss);
            if(ret < 0)
            {
                printf("lynq_Gnss_Stop fail\n");
                qser_Gnss_Deinit(ph_gnss);
                return -1;
            }
            printf("stop success\n");
            break; 
        }
/*
        case 8:
        {
            int opt_1;
            DELETE_AIDING_DATA_TYPE_T ptr;
            //qser_Gnss_Delete_Aiding_Data=(int(*)(uint32_t,DELETE_AIDING_DATA_TYPE_T))dlsym(dlHandle_gnss, "qser_Gnss_Delete_Aiding_Data");
            printf("=========delete aiding data type=========\n");
            delete_type();
            scanf("%d", &opt_1);
            switch(opt_1)
            {
            case 0:
            {
                ptr = DELETE_NOTHING;//hot
                break;
            }
            case 1:
            {
                ptr = DELETE_EPHEMERIS;//warm
                break;
            }
            case 2:
            {
                ptr = DELETE_ALMANAC;
                break;
            }
            case 3:
            {
                ptr = DELETE_POSITION_TIME;
                break;
            }
            case 4:
            {
                ptr = DELETE_UTC;
                break;
            }
            case 5:
            {
                ptr = DELETE_ALL;//cold
                break;
            }
            }
            ret = qser_Gnss_Delete_Aiding_Data(ph_gnss,ptr);
            if(ret < 0)
            {
                printf("lynq_Gnss_Delete_Aiding_Data %d fail\n",opt_1);
                qser_Gnss_Deinit(ph_gnss);
                return -1;
            }
            printf("lynq_Gnss_Delete_Aiding_Data %d success\n",opt_1);
            break;
        }
        case 9:
        {
            LYNQ_INJECT_TIME_INTO_T time_test;
            //qser_Gnss_InjectTime=(int(*)(uint32_t,LYNQ_INJECT_TIME_INTO_T *time_info))dlsym(dlHandle_gnss, "qser_Gnss_InjectTime");
            ret = qser_Gnss_InjectTime(ph_gnss,&time_test);
            if(ret < 0)
            {
                printf("qser_Gnss_InjectTime fail\n");
                qser_Gnss_Deinit(ph_gnss);
                return -1;
            }
            printf("qser_Gnss_InjectTime success\n");
            break;
        }
        case 10:
        {
            //qser_Gnss_download_tle=(int(*)())dlsym(dlHandle_gnss, "qser_Gnss_download_tle");
            ret = qser_Gnss_download_tle();
            if(ret < 0)
            {
                printf("qser_Gnss_download_tle fail\n");
                return -1;
            }
            printf("qser_Gnss_download_tle success\n");
            break;
        }
        case 11:
        {
            int frequency;
            //qser_Gnss_Set_Frequency=(int(*)(uint32_t, int))dlsym(dlHandle_gnss, "qser_Gnss_Set_Frequency");
            printf("=========delete aiding data type=========\n");
            scanf("%d", &frequency);
            ret = qser_Gnss_Set_Frequency(ph_gnss,frequency);
            if(ret < 0)
            {
                printf("qser_Gnss_Set_Frequency fail\n");
                return -1;
            }
            printf("frequency is %d\n",frequency);
            printf("qser_Gnss_Set_Frequency success\n");
            break;
        }
        case 12:
        {
            //int (*qser_Gnss_injectEphemeris)(uint32_t);
            //qser_Gnss_injectEphemeris=(int(*)(uint32_t))dlsym(dlHandle_gnss, "qser_Gnss_injectEphemeris");
            ret = qser_Gnss_injectEphemeris(ph_gnss);
            if(ret < 0)
            {
                printf("qser_Gnss_injectEphemeris fail\n");
                return -1;
            }
            printf("qser_Gnss_injectEphemeri ssuccess\n");
            break;
        }
        case 13:
        {
            //qser_Gnss_Server_Configuration=(int(*)(char *host, char *id, char *password))dlsym(dlHandle_gnss, "qser_Gnss_Server_Configuration");
            ret = qser_Gnss_Server_Configuration(NULL,"lcz","123456");
            if(ret < 0)
            {
                printf("qser_Gnss_Server_Configuration fail\n");
                return -1;
            }
            printf("qser_Gnss_Server_Configuration ssuccess\n");
            break;
        }
        case 14:
        {
            //qser_Gnss_Server_Configuration=(int(*)(char *host, char *id, char *password))dlsym(dlHandle_gnss, "qser_Gnss_Server_Configuration");
            ret = qser_Gnss_Set_Async_Callback(async_cb);
            if(ret < 0)
            {
                printf("qser_Gnss_Set_Async_Callback fail\n");
                return -1;
            }
            printf("qser_Gnss_Set_Async_Callback ssuccess\n");
            break;
        }
        case 15:
        {
            //qser_Gnss_Server_Configuration=(int(*)(char *host, char *id, char *password))dlsym(dlHandle_gnss, "qser_Gnss_Server_Configuration");
            ret = qser_Gnss_Start_Async(ph_gnss);
            if(ret < 0)
            {
                printf("qser_Gnss_Start_Async fail\n");
                return -1;
            }
            printf("qser_Gnss_Start_Async ssuccess\n");
            break;
        }
        */
        }
    }
    return 0;
}