void
get_mbg_utc(
unsigned char **buffpp,
UTC *utcp
)
{
utcp->csum = get_lsb_short(buffpp);
utcp->valid = get_lsb_short(buffpp);
get_mbg_tgps(buffpp, &utcp->t0t);
if (fetch_ieee754(buffpp, IEEE_DOUBLE, &utcp->A0, mbg_double) != IEEE_OK)
{
L_CLR(&utcp->A0);
}
if (fetch_ieee754(buffpp, IEEE_DOUBLE, &utcp->A1, mbg_double) != IEEE_OK)
{
L_CLR(&utcp->A1);
}
utcp->WNlsf = get_lsb_short(buffpp);
utcp->DNt = get_lsb_short(buffpp);
utcp->delta_tls = *(*buffpp)++;
utcp->delta_tlsf = *(*buffpp)++;
}
void
get_mbg_synth(
unsigned char **buffpp,
SYNTH *synthp
)
{
synthp->freq = get_lsb_short(buffpp);
synthp->range = get_lsb_short(buffpp);
synthp->phase = get_lsb_short(buffpp);
}
void
get_mbg_ascii_msg(
unsigned char **bufpp,
ASCII_MSG *ascii_msgp
)
{
ascii_msgp->csum = get_lsb_short(bufpp);
ascii_msgp->valid = get_lsb_short(bufpp);
memcpy(ascii_msgp->s, *bufpp, sizeof(ascii_msgp->s));
*bufpp += sizeof(ascii_msgp->s);
}
void
get_mbg_header(
unsigned char **bufpp,
GPS_MSG_HDR *headerp
)
{
headerp->cmd = (GPS_CMD) get_lsb_short(bufpp);
headerp->len = get_lsb_uint16(bufpp);
headerp->data_csum = (CSUM) get_lsb_short(bufpp);
headerp->hdr_csum = (CSUM) get_lsb_short(bufpp);
}
void
get_mbg_header(
unsigned char **bufpp,
GPS_MSG_HDR *headerp
)
{
headerp->gps_cmd = get_lsb_short(bufpp);
headerp->gps_len = get_lsb_short(bufpp);
headerp->gps_data_csum = get_lsb_short(bufpp);
headerp->gps_hdr_csum = get_lsb_short(bufpp);
}
void
get_mbg_cfg(
unsigned char **bufpp,
CFG *cfgp
)
{
*cfgp = get_lsb_short(bufpp);
}
void
get_mbg_health(
unsigned char **bufpp,
HEALTH *healthp
)
{
*healthp = get_lsb_short(bufpp);
}
void
get_mbg_svno(
unsigned char **bufpp,
SVNO *svnop
)
{
*svnop = get_lsb_short(bufpp);
}
void
get_mbg_tm(
unsigned char **buffpp,
TM *tmp
)
{
tmp->year = get_lsb_short(buffpp);
tmp->month = *(*buffpp)++;
tmp->mday = *(*buffpp)++;
tmp->yday = get_lsb_short(buffpp);
tmp->wday = *(*buffpp)++;
tmp->hour = *(*buffpp)++;
tmp->minute = *(*buffpp)++;
tmp->second = *(*buffpp)++;
tmp->frac = get_lsb_long(buffpp);
tmp->offs_from_utc = get_lsb_long(buffpp);
tmp->status= get_lsb_short(buffpp);
}
void
get_mbg_eph(
unsigned char ** buffpp,
EPH *ephp
)
{
ephp->csum = (CSUM) get_lsb_short(buffpp);
ephp->valid = get_lsb_int16(buffpp);
ephp->health = (HEALTH) get_lsb_short(buffpp);
ephp->IODC = (IOD) get_lsb_short(buffpp);
ephp->IODE2 = (IOD) get_lsb_short(buffpp);
ephp->IODE3 = (IOD) get_lsb_short(buffpp);
get_mbg_tgps(buffpp, &ephp->tt);
get_mbg_tgps(buffpp, &ephp->t0c);
get_mbg_tgps(buffpp, &ephp->t0e);
FETCH_DOUBLE(buffpp, &ephp->sqrt_A);
FETCH_DOUBLE(buffpp, &ephp->e);
FETCH_DOUBLE(buffpp, &ephp->M0);
FETCH_DOUBLE(buffpp, &ephp->omega);
FETCH_DOUBLE(buffpp, &ephp->OMEGA0);
FETCH_DOUBLE(buffpp, &ephp->OMEGADOT);
FETCH_DOUBLE(buffpp, &ephp->deltan);
FETCH_DOUBLE(buffpp, &ephp->i0);
FETCH_DOUBLE(buffpp, &ephp->idot);
FETCH_DOUBLE(buffpp, &ephp->crc);
FETCH_DOUBLE(buffpp, &ephp->crs);
FETCH_DOUBLE(buffpp, &ephp->cuc);
FETCH_DOUBLE(buffpp, &ephp->cus);
FETCH_DOUBLE(buffpp, &ephp->cic);
FETCH_DOUBLE(buffpp, &ephp->cis);
FETCH_DOUBLE(buffpp, &ephp->af0);
FETCH_DOUBLE(buffpp, &ephp->af1);
FETCH_DOUBLE(buffpp, &ephp->af2);
FETCH_DOUBLE(buffpp, &ephp->tgd);
ephp->URA = get_lsb_uint16(buffpp);
ephp->L2code = *(*buffpp)++;
ephp->L2flag = *(*buffpp)++;
}
void
get_mbg_tgps(
unsigned char **bufpp,
T_GPS *tgpsp
)
{
tgpsp->wn = get_lsb_short(bufpp);
tgpsp->sec = get_lsb_long(bufpp);
tgpsp->tick = get_lsb_long(bufpp);
}
void
get_mbg_sw_rev(
unsigned char **bufpp,
SW_REV *sw_revp
)
{
sw_revp->code = get_lsb_short(bufpp);
memcpy(sw_revp->name, *bufpp, sizeof(sw_revp->name));
*bufpp += sizeof(sw_revp->name);
}
void
get_mbg_iono(
unsigned char **buffpp,
IONO *ionop
)
{
ionop->csum = get_lsb_short(buffpp);
ionop->valid = get_lsb_short(buffpp);
FETCH_DOUBLE(buffpp, &ionop->alpha_0);
FETCH_DOUBLE(buffpp, &ionop->alpha_1);
FETCH_DOUBLE(buffpp, &ionop->alpha_2);
FETCH_DOUBLE(buffpp, &ionop->alpha_3);
FETCH_DOUBLE(buffpp, &ionop->beta_0);
FETCH_DOUBLE(buffpp, &ionop->beta_1);
FETCH_DOUBLE(buffpp, &ionop->beta_2);
FETCH_DOUBLE(buffpp, &ionop->beta_3);
}
void
get_mbg_ttm(
unsigned char **buffpp,
TTM *ttmp
)
{
ttmp->channel = get_lsb_short(buffpp);
get_mbg_tgps(buffpp, &ttmp->t);
get_mbg_tm(buffpp, &ttmp->tm);
}
void
get_mbg_antinfo(
unsigned char **buffpp,
ANT_INFO *antinfop
)
{
antinfop->status = get_lsb_short(buffpp);
get_mbg_tm(buffpp, &antinfop->tm_disconn);
get_mbg_tm(buffpp, &antinfop->tm_reconn);
antinfop->delta_t = get_lsb_long(buffpp);
}
void
get_mbg_alm(
unsigned char **buffpp,
ALM *almp
)
{
almp->csum = get_lsb_short(buffpp);
almp->valid = get_lsb_short(buffpp);
almp->health = get_lsb_short(buffpp);
get_mbg_tgps(buffpp, &almp->t0a);
FETCH_DOUBLE(buffpp, &almp->sqrt_A);
FETCH_DOUBLE(buffpp, &almp->e);
FETCH_DOUBLE(buffpp, &almp->M0);
FETCH_DOUBLE(buffpp, &almp->omega);
FETCH_DOUBLE(buffpp, &almp->OMEGA0);
FETCH_DOUBLE(buffpp, &almp->OMEGADOT);
FETCH_DOUBLE(buffpp, &almp->deltai);
FETCH_DOUBLE(buffpp, &almp->af0);
FETCH_DOUBLE(buffpp, &almp->af1);
}
static void
get_mbg_comparam(
unsigned char **buffpp,
COM_PARM *comparamp
)
{
size_t i;
comparamp->baud_rate = get_lsb_long(buffpp);
for (i = 0; i < sizeof(comparamp->framing); i++)
{
comparamp->framing[i] = *(*buffpp)++;
}
comparamp->handshake = get_lsb_short(buffpp);
}
void
get_mbg_cfgh(
unsigned char **buffpp,
CFGH *cfghp
)
{
int i;
cfghp->csum = get_lsb_short(buffpp);
cfghp->valid = get_lsb_short(buffpp);
get_mbg_tgps(buffpp, &cfghp->tot_51);
get_mbg_tgps(buffpp, &cfghp->tot_63);
get_mbg_tgps(buffpp, &cfghp->t0a);
for (i = MIN_SVNO; i <= MAX_SVNO; i++)
{
get_mbg_cfg(buffpp, &cfghp->cfg[i]);
}
for (i = MIN_SVNO; i <= MAX_SVNO; i++)
{
get_mbg_health(buffpp, &cfghp->health[i]);
}
}
void
get_mbg_cfgh(
unsigned char **buffpp,
CFGH *cfghp
)
{
int i;
cfghp->csum = (CSUM) get_lsb_short(buffpp);
cfghp->valid = get_lsb_int16(buffpp);
get_mbg_tgps(buffpp, &cfghp->tot_51);
get_mbg_tgps(buffpp, &cfghp->tot_63);
get_mbg_tgps(buffpp, &cfghp->t0a);
for (i = 0; i < N_SVNO_GPS; i++)
{
get_mbg_cfg(buffpp, &cfghp->cfg[i]);
}
for (i = 0; i < N_SVNO_GPS; i++)
{
get_mbg_health(buffpp, &cfghp->health[i]);
}
}
