Init Project for GPS

main.cpp

Committer:
AustinKim
Date:
2019-09-11
Revision:
0:6d4ac55b6b76

File content as of revision 0:6d4ac55b6b76:

/* WIZnet IoT Shield Cat.M1 Sample code for Arm MBED
 * Copyright (c) 2019 WIZnet Co., Ltd.
 * SPDX-License-Identifier: Apache-2.0
 */
 
 /* 
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *     http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 *
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *
 */

#include "mbed.h"

#include <string>

#define RET_OK                      1
#define RET_NOK                     -1
#define DEBUG_ENABLE                1
#define DEBUG_DISABLE               0
#define ON                          1
#define OFF                         0

#define MAX_BUF_SIZE                1024

#define WM01_APN_PROTOCOL_IPv4      1
#define WM01_APN_PROTOCOL_IPv6      2
#define WM01_DEFAULT_TIMEOUT        1000
#define WM01_CONNECT_TIMEOUT        15000
#define WM01_SEND_TIMEOUT           500
#define WM01_RECV_TIMEOUT           500
#define WM01_BOOTING_TIME           15000

#define WM01_APN_PROTOCOL           WM01_APN_PROTOCOL_IPv6
#define WM01_DEFAULT_BAUD_RATE      115200
#define WM01_PARSER_DELIMITER       "\r\n"

#define CATM1_APN_SKT               "lte-internet.sktelecom.com"

#define CATM1_DEVICE_NAME_WM01      "WM01"
#define DEVNAME                     CATM1_DEVICE_NAME_WM01

#define devlog(f_, ...)             if(CATM1_DEVICE_DEBUG == DEBUG_ENABLE) { pc.printf("\r\n[%s] ", DEVNAME);  pc.printf((f_), ##__VA_ARGS__); }
#define myprintf(f_, ...)           {pc.printf("\r\n[MAIN] ");  pc.printf((f_), ##__VA_ARGS__);}

/* Pin configuraiton */
// Cat.M1
#define MBED_CONF_IOTSHIELD_CATM1_TX        D8
#define MBED_CONF_IOTSHIELD_CATM1_RX        D2
#define MBED_CONF_IOTSHIELD_CATM1_RESET     D7
#define MBED_CONF_IOTSHIELD_CATM1_PWRKEY    D9

// Sensors
#define MBED_CONF_IOTSHIELD_SENSOR_CDS      A0
#define MBED_CONF_IOTSHIELD_SENSOR_TEMP     A1

/* Debug message settings */
#define WM01_PARSER_DEBUG                   DEBUG_DISABLE
#define CATM1_DEVICE_DEBUG                  DEBUG_ENABLE

typedef struct
{
    int date;           // date yyyymmdd
    int utc;            // utc time hhmmss
    float lat;          // latitude. (-)dd.ddddd
    float lon;          // longitude. (-)dd.ddddd
    float spkm;         // speed over ground (km/h) xxx.x
    float cog;          // course over ground ddd.m
    char reli;          // reliability 'A', 'V'
    int lte;            // LTE status
    int emm;            // EMM reject
    int esm;            // ESM reject
    int ss;             // signal strength                              
    int nsat;           // number of satellites 0-12
    char satinfo1[8];   // satellites infomation ID-signal strength
    char satinfo2[8];   // satellites infomation ID-signal strength
    char satinfo3[8];   // satellites infomation ID-signal strength
    char satinfo4[8];   // satellites infomation ID-signal strength
} gps_data;

// Functions: Print information
void printInfo(void);

// Functions: Module Status
void waitCatM1Ready(void);
int8_t setEchoStatus_WM01(bool onoff);
int8_t getUsimStatus_WM01(void);
int8_t getNetworkStatus_WM01(void);

// Functions: GPS
int8_t setGpsOnOff_WM01(bool onoff);
int8_t getGpsInfo_WM01(gps_data *gps_info);

Serial pc(USBTX, USBRX);    // USB debug

UARTSerial *_serial;        // Cat.M1 module    
ATCmdParser *_parser;

DigitalOut _RESET_WM01(MBED_CONF_IOTSHIELD_CATM1_RESET);
DigitalOut _PWRKEY_WM01(MBED_CONF_IOTSHIELD_CATM1_PWRKEY);

void serialPcInit(void)
{
    pc.baud(115200);
    pc.format(8, Serial::None, 1);
}

void serialDeviceInit(PinName tx, PinName rx, int baudrate) 
{        
    _serial = new UARTSerial(tx, rx, baudrate);    
}

void serialAtParserInit(const char *delimiter, bool debug_en)
{
    _parser = new ATCmdParser(_serial);    
    _parser->debug_on(debug_en);
    _parser->set_delimiter(delimiter);    
    _parser->set_timeout(WM01_DEFAULT_TIMEOUT);
}

void catm1DeviceInit(void)
{
    serialDeviceInit(   MBED_CONF_IOTSHIELD_CATM1_TX, 
                        MBED_CONF_IOTSHIELD_CATM1_RX, 
                        WM01_DEFAULT_BAUD_RATE);
                        
    serialAtParserInit( WM01_PARSER_DELIMITER, 
                        WM01_PARSER_DEBUG);
}

void catm1DeviceReset_WM01(void)
{
    _RESET_WM01 = 1;
    _PWRKEY_WM01 = 1;
    wait_ms(300);
    
    _RESET_WM01 = 0;
    _PWRKEY_WM01 = 0;
    wait_ms(400);
    
    _RESET_WM01 = 1;    
    wait_ms(1000);
}

// ----------------------------------------------------------------
// Main routine
// ----------------------------------------------------------------

int main()
{
    gps_data gps_info;

    serialPcInit();    
    catm1DeviceInit();
    
    myprintf("Waiting for Cat.M1 Module Ready...\r\n");
    
    catm1DeviceReset_WM01();
    
    waitCatM1Ready();
    
    wait_ms(5000);
            
    myprintf("System Init Complete\r\n");

    printInfo();

    setEchoStatus_WM01(OFF);
   
    getUsimStatus_WM01();
    
    getNetworkStatus_WM01();

    if(setGpsOnOff_WM01(ON))
    {
        myprintf("GPS On : success\r\n");

        while(1)
        {
            if(getGpsInfo_WM01(&gps_info) == RET_OK)
            {
#if 0
                myprintf("gps_info - reli     : %c", gps_info.reli);            // reliability 'A', 'V'           
                myprintf("gps_info - data     : %d", gps_info.date);            // date yyyymmdd    
                myprintf("gps_info - time     : %d", gps_info.utc);             // utc time hhmmss  
                myprintf("gps_info - lat      : %f", gps_info.lat / 100000);    // latitude. (-)dd.ddddd            
                myprintf("gps_info - lon      : %f", gps_info.lon / 100000);    // longitude. (-)dd.ddddd       
                myprintf("gps_info - spkm     : %.1f", gps_info.spkm);          // speed over ground (km/h) xxx.x   
                myprintf("gps_info - cog      : %.1f", gps_info.cog);           // course over ground ddd.m               
                myprintf("gps_info - lte      : %d", gps_info.lte);             // LTE status
                myprintf("gps_info - emm      : %d", gps_info.emm);             // EMM reject
                myprintf("gps_info - esm      : %d", gps_info.esm);             // ESM reject
                myprintf("gps_info - ss       : %d", gps_info.ss);              // signal strength                 
                myprintf("gps_info - nsat     : %d", gps_info.nsat);            // number of satellites 0-12
                myprintf("gps_info - satinfo1 : %s", gps_info.satinfo1);        // satellites infomation ID-signal strength
                myprintf("gps_info - satinfo2 : %s", gps_info.satinfo2);        // satellites infomation ID-signal strength
                myprintf("gps_info - satinfo3 : %s", gps_info.satinfo3);        // satellites infomation ID-signal strength
                myprintf("gps_info - satinfo4 : %s\r\n", gps_info.satinfo4);    // satellites infomation ID-signal strength
#endif
            }
        }
    }
    else
    {
        myprintf("GPS On : failed\r\n");
    }
}

// ----------------------------------------------------------------
// Functions: Print information
// ----------------------------------------------------------------

void printInfo(void)
{
    myprintf("WIZnet IoT Shield for Arm MBED");
    myprintf("LTE Cat.M1 Version");
    myprintf("=================================================");
    myprintf(">> Target Board: WIoT-WM01 (Woorinet WM-N400MSE)");
    myprintf(">> Sample Code: GPS Test");
    myprintf("=================================================\r\n");
}

// ----------------------------------------------------------------
// Functions: Cat.M1 Status
// ----------------------------------------------------------------

void waitCatM1Ready(void)
{
    while(1) 
    {
        if(_parser->send("AT") && _parser->recv("OK"))
        {
            myprintf("WM01 is Available\r\n");
            
            return;
        }
    }
}

int8_t setEchoStatus_WM01(bool onoff)
{
    int8_t ret = RET_NOK;
    char _buf[10];
    
    sprintf((char *)_buf, "ATE%d", onoff);    
    
    if(_parser->send(_buf) && _parser->recv("OK")) 
    {        
        devlog("Turn Echo %s success\r\n", onoff ? "ON" : "OFF");

        ret = RET_OK;
    } 
    else 
    { 
        devlog("Turn Echo %s failed\r\n", onoff ? "ON" : "OFF");
    }    

    return ret;
}
 
int8_t getUsimStatus_WM01(void)
{
    int8_t ret = RET_NOK;
    
    if(_parser->send("AT$$STAT?") && _parser->recv("$$STAT:READY") && _parser->recv("OK")) 
    {
        devlog("USIM Status : READY\r\n");

        ret = RET_OK;
    } 
    else 
    { 
        devlog("Retrieving USIM Status failed\r\n");        
    }
    
    return ret;
}

int8_t getNetworkStatus_WM01(void)
{
    int8_t ret = RET_NOK;
    int val, stat;
    
    if(_parser->send("AT+CEREG?") && _parser->recv("+CEREG: %d,%d", &val, &stat) && _parser->recv("OK")) 
    {
        if((val == 0) && (stat == 1))
        {
            devlog("Network Status : attached\r\n");

            ret = RET_OK;
        }
        else
        {
            devlog("Network Status : %d, %d\r\n", val, stat);
        }
    }
    else
    {
        devlog("Network Status : Error\r\n");
    }

    return ret;
}

// ----------------------------------------------------------------
// Functions: Cat.M1 GPS
// ----------------------------------------------------------------

int8_t setGpsOnOff_WM01(bool onoff)
{
    int8_t ret = RET_NOK;

    if(onoff == ON)
    {
        if(_parser->send("AT$$GPS") && _parser->recv("OK"))
        {
            devlog("GPS Rx start : success\r\n");

            ret = RET_OK;
        }
        else
        {
            devlog("GPS Rx start : failed\r\n");
        }    
    }
    else if(onoff == OFF)
    {
        if(_parser->send("AT$$GPSSTOP") && _parser->recv("OK"))
        {
            devlog("GPS Rx stop : success\r\n");

            ret = RET_OK;
        }
        else
        {
            devlog("GPS Rx stop : failed\r\n");
        }
    }

    return ret;
}

int8_t getGpsInfo_WM01(gps_data *gps_info)
{
    int8_t ret = RET_NOK;
    char _buf[100] = {0, };
    //char _buf[] = "20190910,111720,3737831,12711294,1,175,A,2,255,255,-31,7,1-32,255-255,11-100,17-22";

    // structure init : GPS info
    gps_info->date = gps_info->utc = gps_info->lte = gps_info->emm = gps_info->esm = gps_info->ss = gps_info->nsat = 0;
    gps_info->lat = gps_info->lon = gps_info->spkm = gps_info->cog = 0.0;
    gps_info->reli = 'V';
    memset(gps_info->satinfo1, 0x00, sizeof(gps_info->satinfo1));
    memset(gps_info->satinfo2, 0x00, sizeof(gps_info->satinfo2));
    memset(gps_info->satinfo3, 0x00, sizeof(gps_info->satinfo3));
    memset(gps_info->satinfo4, 0x00, sizeof(gps_info->satinfo4));

    _parser->flush();

    if(_parser->recv("$$GPS,%s\n", _buf))
    {
        devlog("%s", _buf);

        sscanf(_buf, "%d,%d,%f,%f,%f,%f,%c,%d,%d,%d,%d,%d,%[^,],%[^,],%[^,],%s", 
            &gps_info->date, &gps_info->utc, &gps_info->lat, &gps_info->lon, &gps_info->spkm, &gps_info->cog, &gps_info->reli, &gps_info->lte, 
            &gps_info->emm, &gps_info->esm, &gps_info->ss, &gps_info->nsat, gps_info->satinfo1, gps_info->satinfo2, gps_info->satinfo3, gps_info->satinfo4);

            devlog("gps_info - reli     : %c", gps_info->reli);            // reliability 'A', 'V'           
            devlog("gps_info - data     : %d", gps_info->date);            // date yyyymmdd    
            devlog("gps_info - time     : %d", gps_info->utc);             // utc time hhmmss  
            devlog("gps_info - lat      : %f", gps_info->lat / 100000);    // latitude. (-)dd.ddddd            
            devlog("gps_info - lon      : %f", gps_info->lon / 100000);    // longitude. (-)dd.ddddd       
            devlog("gps_info - spkm     : %.1f", gps_info->spkm);          // speed over ground (km/h) xxx.x   
            devlog("gps_info - cog      : %.1f", gps_info->cog);           // course over ground ddd.m               
            devlog("gps_info - lte      : %d", gps_info->lte);             // LTE status
            devlog("gps_info - emm      : %d", gps_info->emm);             // EMM reject
            devlog("gps_info - esm      : %d", gps_info->esm);             // ESM reject
            devlog("gps_info - ss       : %d", gps_info->ss);              // signal strength                 
            devlog("gps_info - nsat     : %d", gps_info->nsat);            // number of satellites 0-12
            devlog("gps_info - satinfo1 : %s", gps_info->satinfo1);        // satellites infomation ID-signal strength
            devlog("gps_info - satinfo2 : %s", gps_info->satinfo2);        // satellites infomation ID-signal strength
            devlog("gps_info - satinfo3 : %s", gps_info->satinfo3);        // satellites infomation ID-signal strength
            devlog("gps_info - satinfo4 : %s\r\n", gps_info->satinfo4);    // satellites infomation ID-signal strength     

        ret = RET_OK;
    }

    return ret;
}