/* Programheader

        Name:           clock_orbit_rtcm.c
        Project:        RTCM3
        Version:        $Id: clock_orbit_rtcm.c 3728 2012-03-15 13:49:35Z stoecker $
        Authors:        Dirk Stöcker
        Description:    state space approach for RTCM3
*/

#include <math.h>
#include <stdio.h>
#include <string.h>
#ifndef sparc
#include <stdint.h>
#else
#include <sys/types.h>
#endif
#include "clock_orbit_rtcm.h"

static uint32_t CRC24(long size, const unsigned char *buf)
{
  uint32_t crc = 0;
  int i;

  while(size--)
  {
    crc ^= (*buf++) << (16);
    for(i = 0; i < 8; i++)
    {
      crc <<= 1;
      if(crc & 0x1000000)
        crc ^= 0x01864cfb;
    }
  }
  return crc;
}

/* NOTE: These defines are interlinked with below functions and directly modify
the values. This may not be optimized in terms of final program code size but
should be optimized in terms of speed.

modified variables are:
- everything defined in STARTDATA (only use ressize outside of the defines,
  others are private)
- buffer
- size
*/

#ifndef NOENCODE
#define STOREBITS \
  while(numbits >= 8) \
  { \
    if(!size) return 0; \
    *(buffer++) = bitbuffer>>(numbits-8); \
    numbits -= 8; \
    ++ressize; \
    --size; \
  }

#define ADDBITS(a, b) \
  { \
    bitbuffer = (bitbuffer<<(a))|((b)&((1<<a)-1)); \
    numbits += (a); \
    STOREBITS \
  }

#define STARTDATA \
  size_t ressize=0; \
  char *blockstart; \
  int numbits; \
  uint64_t bitbuffer=0;

#define INITBLOCK \
  numbits = 0; \
  blockstart = buffer; \
  ADDBITS(8, 0xD3) \
  ADDBITS(6, 0) \
  ADDBITS(10, 0)

#define ENDBLOCK \
  if(numbits) { ADDBITS((8-numbits), 0) } \
  { \
    int len = buffer-blockstart-3; \
    blockstart[1] |= len>>8; \
    blockstart[2] = len; \
    if(len > 1023) \
      return 0; \
    len = CRC24(len+3, (const unsigned char *) blockstart); \
    ADDBITS(24, len) \
  }

#define SCALEADDBITS(a, b, c) ADDBITS(a, (int64_t)(b*c))

/* standard values */
#define T_MESSAGE_NUMBER(a)              ADDBITS(12, a) /* DF002 */
#define T_GPS_SATELLITE_ID(a)            ADDBITS(6, a)  /* DF068 */
#define T_GPS_IODE(a)                    ADDBITS(8, a)  /* DF071 */
#define T_GLONASS_IOD(a)                 ADDBITS(8, a)  /* DF237 */

/* defined values */
#define T_DELTA_RADIAL(a)                SCALEADDBITS(22,    10000.0, a)
#define T_DELTA_ALONG_TRACK(a)           SCALEADDBITS(20,     2500.0, a)
#define T_DELTA_CROSS_TRACK(a)           SCALEADDBITS(20,     2500.0, a)
#define T_DELTA_DOT_RADIAL(a)            SCALEADDBITS(21,  1000000.0, a)
#define T_DELTA_DOT_ALONG_TRACK(a)       SCALEADDBITS(19,   250000.0, a)
#define T_DELTA_DOT_CROSS_TRACK(a)       SCALEADDBITS(19,   250000.0, a)

#define T_SATELLITE_REFERENCE_DATUM(a)   ADDBITS(1, a)
#define T_DELTA_CLOCK_C0(a)              SCALEADDBITS(22,    10000.0, a)
#define T_DELTA_CLOCK_C1(a)              SCALEADDBITS(21,  1000000.0, a)
#define T_DELTA_CLOCK_C2(a)              SCALEADDBITS(27, 50000000.0, a)
#define T_NO_OF_CODE_BIASES(a)           ADDBITS(5, a)
#define T_GPS_SIGNAL_IDENTIFIER(a)       ADDBITS(5, a)
#define T_GLONASS_SIGNAL_IDENTIFIER(a)   ADDBITS(5, a)
#define T_CODE_BIAS(a)                   SCALEADDBITS(14,      100.0, a)
#define T_GLONASS_SATELLITE_ID(a)        ADDBITS(5, a)

#define T_GPS_EPOCH_TIME(a)              ADDBITS(20, a)
#define T_GLONASS_EPOCH_TIME(a)          ADDBITS(17, a)
#define T_NO_OF_SATELLITES(a)            ADDBITS(6, a)
#define T_MULTIPLE_MESSAGE_INDICATOR(a)  ADDBITS(1, a)
#define T_SSR_URA(a)                     ADDBITS(6, a)
#define T_HR_CLOCK_CORRECTION(a)         SCALEADDBITS(22,    10000.0, a)
#define T_SSR_UPDATE_INTERVAL(a)         ADDBITS(4, a)

#define T_SSR_IOD(a)                     ADDBITS(4, a)
#define T_SSR_PROVIDER_ID(a)             ADDBITS(16, a)
#define T_SSR_SOLUTION_ID(a)             ADDBITS(4, a)

static double URAToValue(int ura)
{
  int urac, urav;
  urac = ura >> 3;
  urav = ura & 7;
  if(!ura)
    return 0;
  else if(ura == 63)
    return SSR_MAXURA;
  return (pow(3,urac)*(1.0+urav/4.0)-1.0)/1000.0;
}

static int ValueToURA(double val)
{
  int ura;
  if(!val)
    return 0;
  else if(val > 5.4665)
    return 63;
  for(ura = 1; ura < 63 && val > URAToValue(ura); ++ura)
    ;
  return ura;
}

size_t MakeClockOrbit(const struct ClockOrbit *co, enum ClockOrbitType type,
int moremessagesfollow, char *buffer, size_t size)
{
  int gpshr=0, gpsur=0, gpsor=0, gpscl=0, gpsco=0, glohr=0, glour=0, gloor=0,
  glocl=0, gloco=0, mmi, i;

  STARTDATA

  if(co->NumberOfGPSSat && co->HRDataSupplied
  && (type == COTYPE_AUTO || type == COTYPE_GPSHR))
    gpshr = 1;
  if(co->NumberOfGPSSat && co->URADataSupplied
  && (type == COTYPE_AUTO || type == COTYPE_GPSURA))
    gpsur = 1;
  if(co->NumberOfGPSSat && co->OrbitDataSupplied
  && (type == COTYPE_AUTO || type == COTYPE_GPSORBIT))
    gpsor = 1;
  if(co->NumberOfGPSSat && co->ClockDataSupplied
  && (type == COTYPE_AUTO || type == COTYPE_GPSCLOCK))
    gpscl = 1;
  if(co->NumberOfGPSSat && co->ClockDataSupplied && co->OrbitDataSupplied
  && (type == COTYPE_AUTO || type == COTYPE_GPSCOMBINED)
  /*&& co->NumberOfGPSSat <= 28*/)
  {
    gpsco = 1; gpsor = 0; gpscl = 0;
  }
  if(co->NumberOfGLONASSSat && co->HRDataSupplied
  && (type == COTYPE_AUTO || type == COTYPE_GLONASSHR))
    glohr = 1;
  if(co->NumberOfGLONASSSat && co->URADataSupplied
  && (type == COTYPE_AUTO || type == COTYPE_GLONASSURA))
    glour = 1;
  if(co->NumberOfGLONASSSat && co->OrbitDataSupplied
  && (type == COTYPE_AUTO || type == COTYPE_GLONASSORBIT))
    gloor = 1;
  if(co->NumberOfGLONASSSat && co->ClockDataSupplied
  && (type == COTYPE_AUTO || type == COTYPE_GLONASSCLOCK))
    glocl = 1;
  if(co->NumberOfGLONASSSat && co->ClockDataSupplied && co->OrbitDataSupplied
  && (type == COTYPE_AUTO || type == COTYPE_GLONASSCOMBINED))
  {
    gloco = 1; gloor = 0; glocl = 0;
  }

  mmi = gpshr+gpsur+gpsor+gpscl+gpsco+glohr+glour+gloor+glocl+gloco; /* required for multimessage */
  if(!moremessagesfollow) --mmi;

  if(gpsor)
  {
    INITBLOCK
    T_MESSAGE_NUMBER(COTYPE_GPSORBIT)
    T_GPS_EPOCH_TIME(co->GPSEpochTime)
    T_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    T_MULTIPLE_MESSAGE_INDICATOR(/*mmi ? 1 :*/0)
    --mmi;
    T_SATELLITE_REFERENCE_DATUM(co->SatRefDatum)
    T_SSR_IOD(co->SSRIOD)
    T_SSR_PROVIDER_ID(co->SSRProviderID)
    T_SSR_SOLUTION_ID(co->SSRSolutionID)
    T_NO_OF_SATELLITES(co->NumberOfGPSSat)
    for(i = 0; i < co->NumberOfGPSSat; ++i)
    {
      T_GPS_SATELLITE_ID(co->Sat[i].ID)
      T_GPS_IODE(co->Sat[i].IOD)
      T_DELTA_RADIAL(co->Sat[i].Orbit.DeltaRadial)
      T_DELTA_ALONG_TRACK(co->Sat[i].Orbit.DeltaAlongTrack)
      T_DELTA_CROSS_TRACK(co->Sat[i].Orbit.DeltaCrossTrack)
      T_DELTA_DOT_RADIAL(co->Sat[i].Orbit.DotDeltaRadial)
      T_DELTA_DOT_ALONG_TRACK(co->Sat[i].Orbit.DotDeltaAlongTrack)
      T_DELTA_DOT_CROSS_TRACK(co->Sat[i].Orbit.DotDeltaCrossTrack)
    }
    ENDBLOCK
  }
  if(gpscl)
  {
    INITBLOCK
    T_MESSAGE_NUMBER(COTYPE_GPSCLOCK)
    T_GPS_EPOCH_TIME(co->GPSEpochTime)
    T_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    T_MULTIPLE_MESSAGE_INDICATOR(/*mmi ? 1 :*/0)
    --mmi;
    T_SSR_IOD(co->SSRIOD)
    T_SSR_PROVIDER_ID(co->SSRProviderID)
    T_SSR_SOLUTION_ID(co->SSRSolutionID)
    T_NO_OF_SATELLITES(co->NumberOfGPSSat)
    for(i = 0; i < co->NumberOfGPSSat; ++i)
    {
      T_GPS_SATELLITE_ID(co->Sat[i].ID)
      T_DELTA_CLOCK_C0(co->Sat[i].Clock.DeltaA0)
      T_DELTA_CLOCK_C1(co->Sat[i].Clock.DeltaA1)
      T_DELTA_CLOCK_C2(co->Sat[i].Clock.DeltaA2)
    }
    ENDBLOCK
  }
  if(gpsco)
  {
#ifdef SPLITBLOCK
    int nums = co->NumberOfGPSSat;
    int left, start = 0;
    if(nums > 28) /* split block when more than 28 sats */
    {
      left = nums - 28;
      nums = 28;
    }
    else
    {
      left = 0;
    }
    while(nums)
    {
#endif
      INITBLOCK
      T_MESSAGE_NUMBER(COTYPE_GPSCOMBINED)
      T_GPS_EPOCH_TIME(co->GPSEpochTime)
      T_SSR_UPDATE_INTERVAL(co->UpdateInterval)
#ifdef SPLITBLOCK
      T_MULTIPLE_MESSAGE_INDICATOR(/*mmi || */ left ? 1 : 0)
#else
      T_MULTIPLE_MESSAGE_INDICATOR(/*mmi || */ 0)
#endif
      --mmi;
      T_SATELLITE_REFERENCE_DATUM(co->SatRefDatum)
      T_SSR_IOD(co->SSRIOD)
      T_SSR_PROVIDER_ID(co->SSRProviderID)
      T_SSR_SOLUTION_ID(co->SSRSolutionID)
#ifdef SPLITBLOCK
      T_NO_OF_SATELLITES(nums)
      for(i = start; i < start+nums; ++i)
#else
      T_NO_OF_SATELLITES(co->NumberOfGPSSat)
      for(i = 0; i < co->NumberOfGPSSat; ++i)
#endif
      {
        T_GPS_SATELLITE_ID(co->Sat[i].ID)
        T_GPS_IODE(co->Sat[i].IOD)
        T_DELTA_RADIAL(co->Sat[i].Orbit.DeltaRadial)
        T_DELTA_ALONG_TRACK(co->Sat[i].Orbit.DeltaAlongTrack)
        T_DELTA_CROSS_TRACK(co->Sat[i].Orbit.DeltaCrossTrack)
        T_DELTA_DOT_RADIAL(co->Sat[i].Orbit.DotDeltaRadial)
        T_DELTA_DOT_ALONG_TRACK(co->Sat[i].Orbit.DotDeltaAlongTrack)
        T_DELTA_DOT_CROSS_TRACK(co->Sat[i].Orbit.DotDeltaCrossTrack)
        T_DELTA_CLOCK_C0(co->Sat[i].Clock.DeltaA0)
        T_DELTA_CLOCK_C1(co->Sat[i].Clock.DeltaA1)
        T_DELTA_CLOCK_C2(co->Sat[i].Clock.DeltaA2)
      }
      ENDBLOCK
#ifdef SPLITBLOCK
      start += nums;
      nums = left;
      left = 0;
    }
#endif
  }
  if(gpshr)
  {
    INITBLOCK
    T_MESSAGE_NUMBER(COTYPE_GPSHR)
    T_GPS_EPOCH_TIME(co->GPSEpochTime)
    T_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    T_MULTIPLE_MESSAGE_INDICATOR(/*mmi ? 1 :*/0)
    --mmi;
    T_SSR_IOD(co->SSRIOD)
    T_SSR_PROVIDER_ID(co->SSRProviderID)
    T_SSR_SOLUTION_ID(co->SSRSolutionID)
    T_NO_OF_SATELLITES(co->NumberOfGPSSat)
    for(i = 0; i < co->NumberOfGPSSat; ++i)
    {
      T_GPS_SATELLITE_ID(co->Sat[i].ID)
      T_HR_CLOCK_CORRECTION(co->Sat[i].hrclock)
    }
    ENDBLOCK
  }
  if(gpsur)
  {
    INITBLOCK
    T_MESSAGE_NUMBER(COTYPE_GPSURA)
    T_GPS_EPOCH_TIME(co->GPSEpochTime)
    T_MULTIPLE_MESSAGE_INDICATOR(/*mmi ? 1 :*/0)
    --mmi;
    T_SSR_IOD(co->SSRIOD)
    T_SSR_PROVIDER_ID(co->SSRProviderID)
    T_SSR_SOLUTION_ID(co->SSRSolutionID)
    T_NO_OF_SATELLITES(co->NumberOfGPSSat)
    for(i = 0; i < co->NumberOfGPSSat; ++i)
    {
      T_GPS_SATELLITE_ID(co->Sat[i].ID)
      T_SSR_URA(ValueToURA(co->Sat[i].UserRangeAccuracy))
    }
    ENDBLOCK
  }
  if(gloor)
  {
    INITBLOCK
    T_MESSAGE_NUMBER(COTYPE_GLONASSORBIT)
    T_GLONASS_EPOCH_TIME(co->GLONASSEpochTime)
    T_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    T_MULTIPLE_MESSAGE_INDICATOR(/*mmi ? 1 :*/0)
    --mmi;
    T_SATELLITE_REFERENCE_DATUM(co->SatRefDatum)
    T_SSR_IOD(co->SSRIOD)
    T_SSR_PROVIDER_ID(co->SSRProviderID)
    T_SSR_SOLUTION_ID(co->SSRSolutionID)
    T_NO_OF_SATELLITES(co->NumberOfGLONASSSat)
    for(i = CLOCKORBIT_NUMGPS;
    i < CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat; ++i)
    {
      T_GLONASS_SATELLITE_ID(co->Sat[i].ID)
      T_GLONASS_IOD(co->Sat[i].IOD)
      T_DELTA_RADIAL(co->Sat[i].Orbit.DeltaRadial)
      T_DELTA_ALONG_TRACK(co->Sat[i].Orbit.DeltaAlongTrack)
      T_DELTA_CROSS_TRACK(co->Sat[i].Orbit.DeltaCrossTrack)
      T_DELTA_DOT_RADIAL(co->Sat[i].Orbit.DotDeltaRadial)
      T_DELTA_DOT_ALONG_TRACK(co->Sat[i].Orbit.DotDeltaAlongTrack)
      T_DELTA_DOT_CROSS_TRACK(co->Sat[i].Orbit.DotDeltaCrossTrack)
    }
    ENDBLOCK
  }
  if(glocl)
  {
    INITBLOCK
    T_MESSAGE_NUMBER(COTYPE_GLONASSCLOCK)
    T_GLONASS_EPOCH_TIME(co->GLONASSEpochTime)
    T_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    T_MULTIPLE_MESSAGE_INDICATOR(/*mmi ? 1 :*/0)
    --mmi;
    T_SSR_IOD(co->SSRIOD)
    T_SSR_PROVIDER_ID(co->SSRProviderID)
    T_SSR_SOLUTION_ID(co->SSRSolutionID)
    T_NO_OF_SATELLITES(co->NumberOfGLONASSSat)
    for(i = CLOCKORBIT_NUMGPS;
    i < CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat; ++i)
    {
      T_GLONASS_SATELLITE_ID(co->Sat[i].ID)
      T_DELTA_CLOCK_C0(co->Sat[i].Clock.DeltaA0)
      T_DELTA_CLOCK_C1(co->Sat[i].Clock.DeltaA1)
      T_DELTA_CLOCK_C2(co->Sat[i].Clock.DeltaA2)
    }
    ENDBLOCK
  }
  if(gloco)
  {
    INITBLOCK
    T_MESSAGE_NUMBER(COTYPE_GLONASSCOMBINED)
    T_GLONASS_EPOCH_TIME(co->GLONASSEpochTime)
    T_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    T_MULTIPLE_MESSAGE_INDICATOR(/*mmi ? 1 :*/0)
    --mmi;
    T_SATELLITE_REFERENCE_DATUM(co->SatRefDatum)
    T_SSR_IOD(co->SSRIOD)
    T_SSR_PROVIDER_ID(co->SSRProviderID)
    T_SSR_SOLUTION_ID(co->SSRSolutionID)
    T_NO_OF_SATELLITES(co->NumberOfGLONASSSat)
    for(i = CLOCKORBIT_NUMGPS;
    i < CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat; ++i)
    {
      T_GLONASS_SATELLITE_ID(co->Sat[i].ID)
      T_GLONASS_IOD(co->Sat[i].IOD)
      T_DELTA_RADIAL(co->Sat[i].Orbit.DeltaRadial)
      T_DELTA_ALONG_TRACK(co->Sat[i].Orbit.DeltaAlongTrack)
      T_DELTA_CROSS_TRACK(co->Sat[i].Orbit.DeltaCrossTrack)
      T_DELTA_DOT_RADIAL(co->Sat[i].Orbit.DotDeltaRadial)
      T_DELTA_DOT_ALONG_TRACK(co->Sat[i].Orbit.DotDeltaAlongTrack)
      T_DELTA_DOT_CROSS_TRACK(co->Sat[i].Orbit.DotDeltaCrossTrack)
      T_DELTA_CLOCK_C0(co->Sat[i].Clock.DeltaA0)
      T_DELTA_CLOCK_C1(co->Sat[i].Clock.DeltaA1)
      T_DELTA_CLOCK_C2(co->Sat[i].Clock.DeltaA2)
    }
    ENDBLOCK
  }
  if(glohr)
  {
    INITBLOCK
    T_MESSAGE_NUMBER(COTYPE_GLONASSHR)
    T_GLONASS_EPOCH_TIME(co->GLONASSEpochTime)
    T_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    T_MULTIPLE_MESSAGE_INDICATOR(/*mmi ? 1 :*/0)
    --mmi;
    T_SSR_IOD(co->SSRIOD)
    T_SSR_PROVIDER_ID(co->SSRProviderID)
    T_SSR_SOLUTION_ID(co->SSRSolutionID)
    T_NO_OF_SATELLITES(co->NumberOfGLONASSSat)
    for(i = CLOCKORBIT_NUMGPS;
    i < CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat; ++i)
    {
      T_GPS_SATELLITE_ID(co->Sat[i].ID)
      T_HR_CLOCK_CORRECTION(co->Sat[i].hrclock)
    }
    ENDBLOCK
  }
  if(glour)
  {
    INITBLOCK
    T_MESSAGE_NUMBER(COTYPE_GLONASSURA)
    T_GLONASS_EPOCH_TIME(co->GLONASSEpochTime)
    T_MULTIPLE_MESSAGE_INDICATOR(/*mmi ? 1 :*/0)
    --mmi;
    T_SSR_IOD(co->SSRIOD)
    T_SSR_PROVIDER_ID(co->SSRProviderID)
    T_SSR_SOLUTION_ID(co->SSRSolutionID)
    T_NO_OF_SATELLITES(co->NumberOfGLONASSSat)
    for(i = CLOCKORBIT_NUMGPS;
    i < CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat; ++i)
    {
      T_GPS_SATELLITE_ID(co->Sat[i].ID)
      T_SSR_URA(ValueToURA(co->Sat[i].UserRangeAccuracy))
    }
    ENDBLOCK
  }

  return ressize;
}

size_t MakeBias(const struct Bias *b, enum BiasType type,
int moremessagesfollow, char *buffer, size_t size)
{
  int gps=0, glo=0, mmi, i, j;

  STARTDATA

  if(b->NumberOfGPSSat && (type == BTYPE_AUTO || type == BTYPE_GPS))
    gps = 1;
  if(b->NumberOfGLONASSSat && (type == BTYPE_AUTO || type == BTYPE_GLONASS))
    glo = 1;

  mmi = gps+glo; /* required for multimessage */
  if(!moremessagesfollow) --mmi;

  if(gps)
  {
    INITBLOCK
    T_MESSAGE_NUMBER(BTYPE_GPS)
    T_GPS_EPOCH_TIME(b->GPSEpochTime)
    T_SSR_UPDATE_INTERVAL(b->UpdateInterval)
    T_MULTIPLE_MESSAGE_INDICATOR(/*mmi ? 1 :*/0)
    --mmi;
    T_SSR_IOD(b->SSRIOD)
    T_SSR_PROVIDER_ID(b->SSRProviderID)
    T_SSR_SOLUTION_ID(b->SSRSolutionID)
    T_NO_OF_SATELLITES(b->NumberOfGPSSat)
    for(i = 0; i < b->NumberOfGPSSat; ++i)
    {
      T_GPS_SATELLITE_ID(b->Sat[i].ID)
      T_NO_OF_CODE_BIASES(b->Sat[i].NumberOfCodeBiases)
      for(j = 0; j < b->Sat[i].NumberOfCodeBiases; ++j)
      {
        T_GPS_SIGNAL_IDENTIFIER(b->Sat[i].Biases[j].Type)
        T_CODE_BIAS(b->Sat[i].Biases[j].Bias)
      }
    }
    ENDBLOCK
  }
  if(glo)
  {
    INITBLOCK
    T_MESSAGE_NUMBER(BTYPE_GLONASS)
    T_GLONASS_EPOCH_TIME(b->GLONASSEpochTime)
    T_SSR_UPDATE_INTERVAL(b->UpdateInterval)
    T_MULTIPLE_MESSAGE_INDICATOR(/*mmi ? 1 :*/0)
    --mmi;
    T_SSR_IOD(b->SSRIOD)
    T_SSR_PROVIDER_ID(b->SSRProviderID)
    T_SSR_SOLUTION_ID(b->SSRSolutionID)
    T_NO_OF_SATELLITES(b->NumberOfGLONASSSat)
    for(i = CLOCKORBIT_NUMGPS;
    i < CLOCKORBIT_NUMGPS+b->NumberOfGLONASSSat; ++i)
    {
      T_GLONASS_SATELLITE_ID(b->Sat[i].ID)
      T_NO_OF_CODE_BIASES(b->Sat[i].NumberOfCodeBiases)
      for(j = 0; j < b->Sat[i].NumberOfCodeBiases; ++j)
      {
        T_GLONASS_SIGNAL_IDENTIFIER(b->Sat[i].Biases[j].Type)
        T_CODE_BIAS(b->Sat[i].Biases[j].Bias)
      }
    }
    ENDBLOCK
  }

  return ressize;
}

#endif /* NOENCODE */

#ifndef NODECODE

#define DECODESTART \
  int numbits=0; \
  uint64_t bitbuffer=0;

#define LOADBITS(a) \
{ \
  while((a) > numbits) \
  { \
    if(!size--) return GCOBR_SHORTMESSAGE; \
    bitbuffer = (bitbuffer<<8)|((unsigned char)*(buffer++)); \
    numbits += 8; \
  } \
}

/* extract bits from data stream
   b = variable to store result, a = number of bits */
#define GETBITS(b, a) \
{ \
  LOADBITS(a) \
  b = (bitbuffer<<(64-numbits))>>(64-(a)); \
  numbits -= (a); \
}

/* extract signed floating value from data stream
   b = variable to store result, a = number of bits */
#define GETFLOATSIGN(b, a, c) \
{ \
  LOADBITS(a) \
  b = ((double)(((int64_t)(bitbuffer<<(64-numbits)))>>(64-(a))))*(c); \
  numbits -= (a); \
}

#define SKIPBITS(b) { LOADBITS(b) numbits -= (b); }

/* standard values */
#define G_HEADER(a)                      GETBITS(a,8)
#define G_RESERVEDH(a)                   GETBITS(a,6)
#define G_SIZE(a)                        GETBITS(a, 10)
#define G_MESSAGE_NUMBER(a)              GETBITS(a, 12) /* DF002 */
#define G_GPS_SATELLITE_ID(a)            GETBITS(a, 6)  /* DF068 */
#define G_GPS_IODE(a)                    GETBITS(a, 8)  /* DF071 */
#define G_GLONASS_IOD(a)                 GETBITS(a, 8)  /* DF237 */

/* defined values */
#define G_DELTA_RADIAL(a)                GETFLOATSIGN(a, 22, 1/10000.0)
#define G_DELTA_ALONG_TRACK(a)           GETFLOATSIGN(a, 20, 1/2500.0)
#define G_DELTA_CROSS_TRACK(a)           GETFLOATSIGN(a, 20, 1/2500.0)
#define G_DELTA_DOT_RADIAL(a)            GETFLOATSIGN(a, 21, 1/1000000.0)
#define G_DELTA_DOT_ALONG_TRACK(a)       GETFLOATSIGN(a, 19, 1/250000.0)
#define G_DELTA_DOT_CROSS_TRACK(a)       GETFLOATSIGN(a, 19, 1/250000.0)

#define G_SATELLITE_REFERENCE_DATUM(a)   GETBITS(a, 1)
#define G_DELTA_CLOCK_C0(a)              GETFLOATSIGN(a, 22, 1/10000.0)
#define G_DELTA_CLOCK_C1(a)              GETFLOATSIGN(a, 21, 1/1000000.0)
#define G_DELTA_CLOCK_C2(a)              GETFLOATSIGN(a, 27, 1/50000000.0)
#define G_NO_OF_CODE_BIASES(a)           GETBITS(a, 5)
#define G_GPS_SIGNAL_IDENTIFIER(a)       GETBITS(a, 5)
#define G_GLONASS_SIGNAL_IDENTIFIER(a)   GETBITS(a, 5)
#define G_CODE_BIAS(a)                   GETFLOATSIGN(a, 14, 1/100.0)
#define G_GLONASS_SATELLITE_ID(a)        GETBITS(a, 5)

#define G_GPS_EPOCH_TIME(a, b)           {int temp; GETBITS(temp, 20) \
 if(b && a != temp) return GCOBR_TIMEMISMATCH; a = temp;}
#define G_GLONASS_EPOCH_TIME(a, b)       {int temp; GETBITS(temp, 17) \
 if(b && a != temp) return GCOBR_TIMEMISMATCH; a = temp;}
#define G_NO_OF_SATELLITES(a)            GETBITS(a, 6)
#define G_MULTIPLE_MESSAGE_INDICATOR(a)  GETBITS(a, 1)
#define G_SSR_URA(a)                     {int temp; GETBITS(temp, 6) \
 (a) = URAToValue(temp);}
#define G_HR_CLOCK_CORRECTION(a)         GETFLOATSIGN(a, 22, 1/10000.0)
#define G_SSR_UPDATE_INTERVAL(a)         GETBITS(a, 4)

#define G_SSR_IOD(a)                     GETBITS(a, 4)
#define G_SSR_PROVIDER_ID(a)             GETBITS(a, 16)
#define G_SSR_SOLUTION_ID(a)             GETBITS(a, 4)

enum GCOB_RETURN GetClockOrbitBias(struct ClockOrbit *co, struct Bias *b,
const char *buffer, size_t size, int *bytesused)
{
  int type, mmi=0, i, j, h, rs, nums, pos, id;
  size_t sizeofrtcmblock;
  const char *blockstart = buffer;
  DECODESTART

  if(size < 7)
    return GCOBR_SHORTBUFFER;

#ifdef DEBUG
fprintf(stderr, "GetClockOrbitBias START: size %d, numbits %d\n",size, numbits);
#endif

  G_HEADER(h)
  G_RESERVEDH(rs)
  G_SIZE(sizeofrtcmblock);

  if((unsigned char)h != 0xD3 || rs)
    return GCOBR_UNKNOWNDATA;
  if(size < sizeofrtcmblock + 3) /* 3 header bytes already removed */
    return GCOBR_MESSAGEEXCEEDSBUFFER;
  if(CRC24(sizeofrtcmblock+3, (const unsigned char *) blockstart) !=
  (uint32_t)((((unsigned char)buffer[sizeofrtcmblock])<<16)|
   (((unsigned char)buffer[sizeofrtcmblock+1])<<8)|
   (((unsigned char)buffer[sizeofrtcmblock+2]))))
    return GCOBR_CRCMISMATCH;
  size = sizeofrtcmblock; /* reduce size, so overflows are detected */

  G_MESSAGE_NUMBER(type)
#ifdef DEBUG
fprintf(stderr, "type %d size %d\n",type,sizeofrtcmblock);
#endif
  switch(type)
  {
  case COTYPE_GPSORBIT:
    if(!co) return GCOBR_NOCLOCKORBITPARAMETER;
    co->messageType = COTYPE_GPSORBIT;
    G_GPS_EPOCH_TIME(co->GPSEpochTime, co->NumberOfGPSSat)
    co->epochGPS[co->epochSize] = co->GPSEpochTime;   /* Weber, for latency */
    if(co->epochSize < 100) {co->epochSize += 1;}     /* Weber, for latency */
    G_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    G_MULTIPLE_MESSAGE_INDICATOR(mmi)
    G_SATELLITE_REFERENCE_DATUM(co->SatRefDatum)
    G_SSR_IOD(co->SSRIOD)
    G_SSR_PROVIDER_ID(co->SSRProviderID)
    G_SSR_SOLUTION_ID(co->SSRSolutionID)
    G_NO_OF_SATELLITES(nums)
    co->OrbitDataSupplied |= 1;
#ifdef DEBUG
fprintf(stderr, "epochtime %d ui %d mmi %d sats %d/%d rd %d\n",co->GPSEpochTime,
co->UpdateInterval,mmi,co->NumberOfGPSSat,nums, co->SatRefDatum);
#endif
    for(i = 0; i < nums; ++i)
    {
      G_GPS_SATELLITE_ID(id)
      for(pos = 0; pos < co->NumberOfGPSSat && co->Sat[pos].ID != id; ++pos)
        ;
      if(pos >= CLOCKORBIT_NUMGPS) return GCOBR_DATAMISMATCH;
      else if(pos == co->NumberOfGPSSat) ++co->NumberOfGPSSat;
      co->Sat[pos].ID = id;

      G_GPS_IODE(co->Sat[pos].IOD)
      G_DELTA_RADIAL(co->Sat[pos].Orbit.DeltaRadial)
      G_DELTA_ALONG_TRACK(co->Sat[pos].Orbit.DeltaAlongTrack)
      G_DELTA_CROSS_TRACK(co->Sat[pos].Orbit.DeltaCrossTrack)
      G_DELTA_DOT_RADIAL(co->Sat[pos].Orbit.DotDeltaRadial)
      G_DELTA_DOT_ALONG_TRACK(co->Sat[pos].Orbit.DotDeltaAlongTrack)
      G_DELTA_DOT_CROSS_TRACK(co->Sat[pos].Orbit.DotDeltaCrossTrack)
#ifdef DEBUG
fprintf(stderr, "id %2d iod %3d dr %8.3f da %8.3f dc %8.3f dr %8.3f da %8.3f dc %8.3f\n",
co->Sat[pos].ID,co->Sat[pos].IOD,co->Sat[pos].Orbit.DeltaRadial,
co->Sat[pos].Orbit.DeltaAlongTrack,co->Sat[pos].Orbit.DeltaCrossTrack,
co->Sat[pos].Orbit.DotDeltaRadial,
co->Sat[pos].Orbit.DotDeltaAlongTrack,
co->Sat[pos].Orbit.DotDeltaCrossTrack);
#endif
    }
    break;
  case COTYPE_GPSCLOCK:
    if(!co) return GCOBR_NOCLOCKORBITPARAMETER;
    co->messageType = COTYPE_GPSCLOCK;
    G_GPS_EPOCH_TIME(co->GPSEpochTime, co->NumberOfGPSSat)
    co->epochGPS[co->epochSize] = co->GPSEpochTime;   /* Weber, for latency */
    if(co->epochSize < 100) {co->epochSize += 1;}     /* Weber, for latency */
    G_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    G_MULTIPLE_MESSAGE_INDICATOR(mmi)
    G_SSR_IOD(co->SSRIOD)
    G_SSR_PROVIDER_ID(co->SSRProviderID)
    G_SSR_SOLUTION_ID(co->SSRSolutionID)
    G_NO_OF_SATELLITES(nums)
    co->ClockDataSupplied |= 1;
#ifdef DEBUG
fprintf(stderr, "epochtime %d ui %d mmi %d sats %d/%d\n",co->GPSEpochTime,
co->UpdateInterval,mmi,co->NumberOfGPSSat,nums);
#endif
    for(i = 0; i < nums; ++i)
    {
      G_GPS_SATELLITE_ID(id)
      for(pos = 0; pos < co->NumberOfGPSSat && co->Sat[pos].ID != id; ++pos)
        ;
      if(pos >= CLOCKORBIT_NUMGPS) return GCOBR_DATAMISMATCH;
      else if(pos == co->NumberOfGPSSat) ++co->NumberOfGPSSat;
      co->Sat[pos].ID = id;

      G_DELTA_CLOCK_C0(co->Sat[pos].Clock.DeltaA0)
      G_DELTA_CLOCK_C1(co->Sat[pos].Clock.DeltaA1)
      G_DELTA_CLOCK_C2(co->Sat[pos].Clock.DeltaA2)
#ifdef DEBUG
fprintf(stderr, "id %2d c0 %8.3f c1 %8.3f c2 %8.3f\n",
co->Sat[pos].ID, co->Sat[pos].Clock.DeltaA0, co->Sat[pos].Clock.DeltaA1,
co->Sat[pos].Clock.DeltaA2);
#endif
    }
    break;
  case COTYPE_GPSCOMBINED:
    if(!co) return GCOBR_NOCLOCKORBITPARAMETER;
    co->messageType = COTYPE_GPSCOMBINED;
    G_GPS_EPOCH_TIME(co->GPSEpochTime, co->NumberOfGPSSat)
    co->epochGPS[co->epochSize] = co->GPSEpochTime;   /* Weber, for latency */
    if(co->epochSize < 100) {co->epochSize += 1;}     /* Weber, for latency */
    G_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    G_MULTIPLE_MESSAGE_INDICATOR(mmi)
    G_SATELLITE_REFERENCE_DATUM(co->SatRefDatum)
    G_SSR_IOD(co->SSRIOD)
    G_SSR_PROVIDER_ID(co->SSRProviderID)
    G_SSR_SOLUTION_ID(co->SSRSolutionID)
    G_NO_OF_SATELLITES(nums)
    co->OrbitDataSupplied |= 1;
    co->ClockDataSupplied |= 1;
    for(i = 0; i < nums; ++i)
    {
      G_GPS_SATELLITE_ID(id)
      for(pos = 0; pos < co->NumberOfGPSSat && co->Sat[pos].ID != id; ++pos)
        ;
      if(pos >= CLOCKORBIT_NUMGPS) return GCOBR_DATAMISMATCH;
      else if(pos == co->NumberOfGPSSat) ++co->NumberOfGPSSat;
      co->Sat[pos].ID = id;

      G_GPS_IODE(co->Sat[pos].IOD)
      G_DELTA_RADIAL(co->Sat[pos].Orbit.DeltaRadial)
      G_DELTA_ALONG_TRACK(co->Sat[pos].Orbit.DeltaAlongTrack)
      G_DELTA_CROSS_TRACK(co->Sat[pos].Orbit.DeltaCrossTrack)
      G_DELTA_DOT_RADIAL(co->Sat[pos].Orbit.DotDeltaRadial)
      G_DELTA_DOT_ALONG_TRACK(co->Sat[pos].Orbit.DotDeltaAlongTrack)
      G_DELTA_DOT_CROSS_TRACK(co->Sat[pos].Orbit.DotDeltaCrossTrack)
      G_DELTA_CLOCK_C0(co->Sat[pos].Clock.DeltaA0)
      G_DELTA_CLOCK_C1(co->Sat[pos].Clock.DeltaA1)
      G_DELTA_CLOCK_C2(co->Sat[pos].Clock.DeltaA2)
    }
    break;
  case COTYPE_GPSURA:
    if(!co) return GCOBR_NOCLOCKORBITPARAMETER;
    co->messageType = COTYPE_GPSURA;
    G_GPS_EPOCH_TIME(co->GPSEpochTime, co->NumberOfGPSSat)
    co->epochGPS[co->epochSize] = co->GPSEpochTime;   /* Weber, for latency */
    if(co->epochSize < 100) {co->epochSize += 1;}     /* Weber, for latency */
    G_MULTIPLE_MESSAGE_INDICATOR(mmi)
    G_SSR_IOD(co->SSRIOD)
    G_SSR_PROVIDER_ID(co->SSRProviderID)
    G_SSR_SOLUTION_ID(co->SSRSolutionID)
    G_NO_OF_SATELLITES(nums)
    co->URADataSupplied |= 1;
    for(i = 0; i < nums; ++i)
    {
      G_GPS_SATELLITE_ID(id)
      for(pos = 0; pos < co->NumberOfGPSSat && co->Sat[pos].ID != id; ++pos)
        ;
      if(pos >= CLOCKORBIT_NUMGPS) return GCOBR_DATAMISMATCH;
      else if(pos == co->NumberOfGPSSat) ++co->NumberOfGPSSat;
      co->Sat[pos].ID = id;

      G_SSR_URA(co->Sat[pos].UserRangeAccuracy)
    }
    break;
  case COTYPE_GPSHR:
    if(!co) return GCOBR_NOCLOCKORBITPARAMETER;
    co->messageType = COTYPE_GPSHR;
    G_GPS_EPOCH_TIME(co->GPSEpochTime, co->NumberOfGPSSat)
    co->epochGPS[co->epochSize] = co->GPSEpochTime;   /* Weber, for latency */
    if(co->epochSize < 100) {co->epochSize += 1;}     /* Weber, for latency */
    G_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    G_MULTIPLE_MESSAGE_INDICATOR(mmi)
    G_SSR_IOD(co->SSRIOD)
    G_SSR_PROVIDER_ID(co->SSRProviderID)
    G_SSR_SOLUTION_ID(co->SSRSolutionID)
    G_NO_OF_SATELLITES(nums)
    co->HRDataSupplied |= 1;
    for(i = 0; i < nums; ++i)
    {
      G_GPS_SATELLITE_ID(id)
      for(pos = 0; pos < co->NumberOfGPSSat && co->Sat[pos].ID != id; ++pos)
        ;
      if(pos >= CLOCKORBIT_NUMGPS) return GCOBR_DATAMISMATCH;
      else if(pos == co->NumberOfGPSSat) ++co->NumberOfGPSSat;
      co->Sat[pos].ID = id;

      G_HR_CLOCK_CORRECTION(co->Sat[pos].hrclock)
    }
    break;
  case COTYPE_GLONASSORBIT:
    if(!co) return GCOBR_NOCLOCKORBITPARAMETER;
    co->messageType = COTYPE_GLONASSORBIT;
    G_GLONASS_EPOCH_TIME(co->GLONASSEpochTime, co->NumberOfGLONASSSat)
    G_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    G_MULTIPLE_MESSAGE_INDICATOR(mmi)
    G_SATELLITE_REFERENCE_DATUM(co->SatRefDatum)
    G_SSR_IOD(co->SSRIOD)
    G_SSR_PROVIDER_ID(co->SSRProviderID)
    G_SSR_SOLUTION_ID(co->SSRSolutionID)
    G_NO_OF_SATELLITES(nums)
    co->OrbitDataSupplied |= 2;
#ifdef DEBUG
fprintf(stderr, "epochtime %d ui %d mmi %d sats %d/%d rd %d\n",co->GLONASSEpochTime,
co->UpdateInterval,mmi,co->NumberOfGLONASSSat,nums, co->SatRefDatum);
#endif
    for(i = 0; i < nums; ++i)
    {
      G_GLONASS_SATELLITE_ID(id)
      for(pos = CLOCKORBIT_NUMGPS; pos < CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat && co->Sat[pos].ID != id; ++pos)
        ;
      if(pos >= CLOCKORBIT_NUMGPS+CLOCKORBIT_NUMGLONASS) return GCOBR_DATAMISMATCH;
      else if(pos == CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat) ++co->NumberOfGLONASSSat;
      co->Sat[pos].ID = id;

      G_GLONASS_IOD(co->Sat[pos].IOD)
      G_DELTA_RADIAL(co->Sat[pos].Orbit.DeltaRadial)
      G_DELTA_ALONG_TRACK(co->Sat[pos].Orbit.DeltaAlongTrack)
      G_DELTA_CROSS_TRACK(co->Sat[pos].Orbit.DeltaCrossTrack)
      G_DELTA_DOT_RADIAL(co->Sat[pos].Orbit.DotDeltaRadial)
      G_DELTA_DOT_ALONG_TRACK(co->Sat[pos].Orbit.DotDeltaAlongTrack)
      G_DELTA_DOT_CROSS_TRACK(co->Sat[pos].Orbit.DotDeltaCrossTrack)
#ifdef DEBUG
fprintf(stderr, "id %2d iod %3d dr %8.3f da %8.3f dc %8.3f dr %8.3f da %8.3f dc %8.3f\n",
co->Sat[pos].ID,co->Sat[pos].IOD,co->Sat[pos].Orbit.DeltaRadial,
co->Sat[pos].Orbit.DeltaAlongTrack,co->Sat[pos].Orbit.DeltaCrossTrack,
co->Sat[pos].Orbit.DotDeltaRadial,
co->Sat[pos].Orbit.DotDeltaAlongTrack,
co->Sat[pos].Orbit.DotDeltaCrossTrack);
#endif
    }
    break;
  case COTYPE_GLONASSCLOCK:
    if(!co) return GCOBR_NOCLOCKORBITPARAMETER;
    co->messageType = COTYPE_GLONASSCLOCK;
    G_GLONASS_EPOCH_TIME(co->GLONASSEpochTime, co->NumberOfGLONASSSat)
    G_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    G_MULTIPLE_MESSAGE_INDICATOR(mmi)
    G_SSR_IOD(co->SSRIOD)
    G_SSR_PROVIDER_ID(co->SSRProviderID)
    G_SSR_SOLUTION_ID(co->SSRSolutionID)
    G_NO_OF_SATELLITES(nums)
    co->ClockDataSupplied |= 2;
#ifdef DEBUG
fprintf(stderr, "epochtime %d ui %d mmi %d sats %d/%d\n",co->GLONASSEpochTime,
co->UpdateInterval,mmi,co->NumberOfGLONASSSat,nums);
#endif
    for(i = 0; i < nums; ++i)
    {
      G_GLONASS_SATELLITE_ID(id)
      for(pos = CLOCKORBIT_NUMGPS; pos < CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat && co->Sat[pos].ID != id; ++pos)
        ;
      if(pos >= CLOCKORBIT_NUMGPS+CLOCKORBIT_NUMGLONASS) return GCOBR_DATAMISMATCH;
      else if(pos == CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat) ++co->NumberOfGLONASSSat;
      co->Sat[pos].ID = id;

      G_DELTA_CLOCK_C0(co->Sat[pos].Clock.DeltaA0)
      G_DELTA_CLOCK_C1(co->Sat[pos].Clock.DeltaA1)
      G_DELTA_CLOCK_C2(co->Sat[pos].Clock.DeltaA2)
#ifdef DEBUG
fprintf(stderr, "id %2d c0 %8.3f c1 %8.3f c2 %8.3f\n",
co->Sat[pos].ID, co->Sat[pos].Clock.DeltaA0, co->Sat[pos].Clock.DeltaA1,
co->Sat[pos].Clock.DeltaA2);
#endif
    }
    break;
  case COTYPE_GLONASSCOMBINED:
    if(!co) return GCOBR_NOCLOCKORBITPARAMETER;
    co->messageType = COTYPE_GLONASSCOMBINED;
    G_GLONASS_EPOCH_TIME(co->GLONASSEpochTime, co->NumberOfGLONASSSat)
    G_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    G_MULTIPLE_MESSAGE_INDICATOR(mmi)
    G_SATELLITE_REFERENCE_DATUM(co->SatRefDatum)
    G_SSR_IOD(co->SSRIOD)
    G_SSR_PROVIDER_ID(co->SSRProviderID)
    G_SSR_SOLUTION_ID(co->SSRSolutionID)
    G_NO_OF_SATELLITES(nums)
    co->OrbitDataSupplied |= 2;
    co->ClockDataSupplied |= 2;
    for(i = 0; i < nums; ++i)
    {
      G_GLONASS_SATELLITE_ID(id)
      for(pos = CLOCKORBIT_NUMGPS; pos < CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat && co->Sat[pos].ID != id; ++pos)
        ;
      if(pos >= CLOCKORBIT_NUMGPS+CLOCKORBIT_NUMGLONASS) return GCOBR_DATAMISMATCH;
      else if(pos == CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat) ++co->NumberOfGLONASSSat;
      co->Sat[pos].ID = id;

      G_GLONASS_IOD(co->Sat[pos].IOD)
      G_DELTA_RADIAL(co->Sat[pos].Orbit.DeltaRadial)
      G_DELTA_ALONG_TRACK(co->Sat[pos].Orbit.DeltaAlongTrack)
      G_DELTA_CROSS_TRACK(co->Sat[pos].Orbit.DeltaCrossTrack)
      G_DELTA_DOT_RADIAL(co->Sat[pos].Orbit.DotDeltaRadial)
      G_DELTA_DOT_ALONG_TRACK(co->Sat[pos].Orbit.DotDeltaAlongTrack)
      G_DELTA_DOT_CROSS_TRACK(co->Sat[pos].Orbit.DotDeltaCrossTrack)
      G_DELTA_CLOCK_C0(co->Sat[pos].Clock.DeltaA0)
      G_DELTA_CLOCK_C1(co->Sat[pos].Clock.DeltaA1)
      G_DELTA_CLOCK_C2(co->Sat[pos].Clock.DeltaA2)
    }
    break;
  case COTYPE_GLONASSURA:
    if(!co) return GCOBR_NOCLOCKORBITPARAMETER;
    co->messageType = COTYPE_GLONASSURA;
    G_GLONASS_EPOCH_TIME(co->GLONASSEpochTime, co->NumberOfGLONASSSat)
    G_MULTIPLE_MESSAGE_INDICATOR(mmi)
    G_SSR_IOD(co->SSRIOD)
    G_SSR_PROVIDER_ID(co->SSRProviderID)
    G_SSR_SOLUTION_ID(co->SSRSolutionID)
    G_NO_OF_SATELLITES(nums)
    co->URADataSupplied |= 2;
    for(i = 0; i < nums; ++i)
    {
      G_GLONASS_SATELLITE_ID(id)
      for(pos = CLOCKORBIT_NUMGPS; pos < CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat && co->Sat[pos].ID != id; ++pos)
        ;
      if(pos >= CLOCKORBIT_NUMGPS+CLOCKORBIT_NUMGLONASS) return GCOBR_DATAMISMATCH;
      else if(pos == CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat) ++co->NumberOfGLONASSSat;
      co->Sat[pos].ID = id;

      G_SSR_URA(co->Sat[pos].UserRangeAccuracy)
    }
    break;
  case COTYPE_GLONASSHR:
    if(!co) return GCOBR_NOCLOCKORBITPARAMETER;
    co->messageType = COTYPE_GLONASSHR;
    G_GLONASS_EPOCH_TIME(co->GLONASSEpochTime, co->NumberOfGLONASSSat)
    G_SSR_UPDATE_INTERVAL(co->UpdateInterval)
    G_MULTIPLE_MESSAGE_INDICATOR(mmi)
    G_SSR_IOD(co->SSRIOD)
    G_SSR_PROVIDER_ID(co->SSRProviderID)
    G_SSR_SOLUTION_ID(co->SSRSolutionID)
    G_NO_OF_SATELLITES(nums)
    co->HRDataSupplied |= 2;
    for(i = 0; i < nums; ++i)
    {
      G_GLONASS_SATELLITE_ID(id)
      for(pos = CLOCKORBIT_NUMGPS; pos < CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat && co->Sat[pos].ID != id; ++pos)
        ;
      if(pos >= CLOCKORBIT_NUMGPS+CLOCKORBIT_NUMGLONASS) return GCOBR_DATAMISMATCH;
      else if(pos == CLOCKORBIT_NUMGPS+co->NumberOfGLONASSSat) ++co->NumberOfGLONASSSat;
      co->Sat[pos].ID = id;

      G_HR_CLOCK_CORRECTION(co->Sat[pos].hrclock)
    }
    break;
  case BTYPE_GPS:
    if(!b) return GCOBR_NOBIASPARAMETER;
    b->messageType = BTYPE_GPS;
    G_GPS_EPOCH_TIME(b->GPSEpochTime, b->NumberOfGPSSat)
    G_SSR_UPDATE_INTERVAL(b->UpdateInterval)
    G_MULTIPLE_MESSAGE_INDICATOR(mmi)
    G_SSR_IOD(b->SSRIOD)
    G_SSR_PROVIDER_ID(b->SSRProviderID)
    G_SSR_SOLUTION_ID(b->SSRSolutionID)
    G_NO_OF_SATELLITES(nums)
    for(i = 0; i < nums; ++i)
    {
      G_GPS_SATELLITE_ID(id)
      for(pos = 0; pos < b->NumberOfGPSSat && b->Sat[pos].ID != id; ++pos)
        ;
      if(pos >= CLOCKORBIT_NUMGPS) return GCOBR_DATAMISMATCH;
      else if(pos == b->NumberOfGPSSat) ++b->NumberOfGPSSat;
      b->Sat[pos].ID = id;

      G_NO_OF_CODE_BIASES(b->Sat[pos].NumberOfCodeBiases)
      for(j = 0; j < b->Sat[pos].NumberOfCodeBiases; ++j)
      {
        G_GPS_SIGNAL_IDENTIFIER(b->Sat[pos].Biases[j].Type)
        G_CODE_BIAS(b->Sat[pos].Biases[j].Bias)
      }
    }
    break;
  case BTYPE_GLONASS:
    if(!b) return GCOBR_NOBIASPARAMETER;
    b->messageType = BTYPE_GLONASS;
    G_GLONASS_EPOCH_TIME(b->GLONASSEpochTime, b->NumberOfGLONASSSat)
    G_SSR_UPDATE_INTERVAL(b->UpdateInterval)
    G_MULTIPLE_MESSAGE_INDICATOR(mmi)
    G_SSR_IOD(b->SSRIOD)
    G_SSR_PROVIDER_ID(b->SSRProviderID)
    G_SSR_SOLUTION_ID(b->SSRSolutionID)
    G_NO_OF_SATELLITES(nums)
    for(i = 0; i < nums; ++i)
    {
      G_GLONASS_SATELLITE_ID(id)
      for(pos = CLOCKORBIT_NUMGPS; pos < b->NumberOfGLONASSSat && b->Sat[pos].ID != id; ++pos)
        ;
      if(pos >= CLOCKORBIT_NUMGPS+CLOCKORBIT_NUMGLONASS) return GCOBR_DATAMISMATCH;
      else if(pos == b->NumberOfGLONASSSat) ++b->NumberOfGLONASSSat;
      b->Sat[pos].ID = id;

      G_NO_OF_CODE_BIASES(b->Sat[pos].NumberOfCodeBiases)
      for(j = 0; j < b->Sat[pos].NumberOfCodeBiases; ++j)
      {
        G_GLONASS_SIGNAL_IDENTIFIER(b->Sat[pos].Biases[j].Type)
        G_CODE_BIAS(b->Sat[pos].Biases[j].Bias)
      }
    }
    break;
  default:
    if(bytesused)
      *bytesused = sizeofrtcmblock+6;
    return GCOBR_UNKNOWNTYPE;
  }
#ifdef DEBUG
for(type = 0; type < (int)size && (unsigned char)buffer[type] != 0xD3; ++type)
  numbits += 8;
fprintf(stderr, "numbits left %d\n",numbits);
#endif
  if(bytesused)
    *bytesused = sizeofrtcmblock+6;
  return mmi ? GCOBR_MESSAGEFOLLOWS : GCOBR_OK;
}
#endif /* NODECODE */