VGKitBoard_7669T/radio/navdata.c

/*
 * =====================================================================================
 *
 *       Filename:  navdata.c
 *
 *    Description:  Nav data source file
 *
 *        Version:  1.0
 *        Created:  2018/8/15 17:31:22
 *       Revision:  none
 *       Compiler:  gcc
 *
 *         Author:  Jarod Lee 
 *   Organization:  
 *
 * =====================================================================================
 */
#include <stdlib.h>
#include <string.h>
#include <stdio.h>
#include "navdata.h"

#define PRN_PLUS_GLN    64
#define PRN_PLUS_BDS    200
/*
 * PRN and SVID
 * PRN is the satellite's NO. in NMEA protocol.
 * SVID is the satellite's id in all constellations.
 * 1-64:        GPS 
 * 65-96:       GLNONASS 
 * 201-264:     Beidou
 */

/*
 * Convert prn and constell to svid
 * @prn:        prn of the satellite
 * @constell:   constellation type
 * @return:     svid of the satellite
 */
int prn2svid(int prn, int constell) 
{
        switch (constell) {
        case CONSTELL_TYPE_GPS:
                break;
        case CONSTELL_TYPE_GLN:
                if (prn > 0 && prn < 33)
                        prn += PRN_PLUS_GLN;
                break;
        case CONSTELL_TYPE_BDS:
                if (prn > 0 && prn < 65)
                        prn += PRN_PLUS_BDS;
                break;
        default:
                break;
        }

        return prn;
}

/*
 * Tell the constellation type of a SVID
 * @sivd:       the SVID
 * @return:     the constellationtype
 */
int tell_constell(int svid) 
{
        if (svid > 0 && svid < 65) {
                return CONSTELL_TYPE_GPS;
        }
        else if (svid > 64 && svid < 97) {
                return CONSTELL_TYPE_GLN;
        }
        else if (svid > 200 && svid < 265) {
                return CONSTELL_TYPE_BDS;
        }

        return CONSTELL_TYPE_UNKNOWN;
}

/*
 * Get constellation's name string
 * @constell:   constellation type
 * @return:     the name string
 */
const char *constell_name(int constell)
{
        switch(constell) {
        case CONSTELL_TYPE_GPS:
                return "GPS";
        case CONSTELL_TYPE_GLN:
                return "GLN";
        case CONSTELL_TYPE_BDS:
                return "BDS";
        default:
                return "UNKNOWN";
        }
}

/*
 * Init navigation data to 0
 * @navdata:    the navigation data
 */
void navdata_init(struct nav_data *navdata) 
{
        memset(navdata, 0, sizeof(struct nav_data));
}