source: ntrip/trunk/BNC/src/RTCM/GPSDecoder.cpp@ 5734

// Part of BNC, a utility for retrieving decoding and
// converting GNSS data streams from NTRIP broadcasters.
//
// Copyright (C) 2007
// German Federal Agency for Cartography and Geodesy (BKG)
// http://www.bkg.bund.de
// Czech Technical University Prague, Department of Geodesy
// http://www.fsv.cvut.cz
//
// Email: euref-ip@bkg.bund.de
//
// This program is free software; you can redistribute it and/or
// modify it under the terms of the GNU General Public License
// as published by the Free Software Foundation, version 2.
//
// This program is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
// GNU General Public License for more details.
//
// You should have received a copy of the GNU General Public License
// along with this program; if not, write to the Free Software
// Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.

/* -------------------------------------------------------------------------
 * BKG NTRIP Client
 * -------------------------------------------------------------------------
 *
 * Class:      GPSDecoder
 *
 * Purpose:    Decoder Base Class
 *
 * Author:     L. Mervart
 *
 * Created:    16-Dec-2011
 *
 * Changes:    
 *
 * -----------------------------------------------------------------------*/

#include <iomanip>
#include <cmath>

#include "GPSDecoder.h"
#include "bncsettings.h"

extern "C" {
#include "rtcm3torinex.h"
}

using namespace std;

// Constructor
//////////////////////////////////////////////////////////////////////////////
GPSDecoder::GPSDecoder() {
  _rnx = 0;
}

// Initialize RINEX Writer
//////////////////////////////////////////////////////////////////////////////
void GPSDecoder::initRinex(const QByteArray& staID, const QUrl& mountPoint,
                           const QByteArray& latitude, 
                           const QByteArray& longitude, const QByteArray& nmea,
                           const QByteArray& ntripVersion) {
  if (_rnx) {
    return;
  }
  bncSettings settings;
  if ( !settings.value("rnxPath").toString().isEmpty() ) { 
    _rnx = new bncRinex(staID, mountPoint, latitude, longitude, 
                        nmea, ntripVersion);
  }
} 

// Write RINEX Epoch
//////////////////////////////////////////////////////////////////////////////
void GPSDecoder::dumpRinexEpoch(const t_obs& obs, const QByteArray& format) {
  if (_rnx) {
    long iSec    = long(floor(obs.GPSWeeks+0.5));
    long obsTime = obs.GPSWeek * 7*24*3600 + iSec;
    if (_rnx->samplingRate() == 0 || iSec % _rnx->samplingRate() == 0) {
      _rnx->deepCopy(obs);
    }
    _rnx->dumpEpoch(format, obsTime);
  }
} 

// Set RINEX Reconnect Flag
//////////////////////////////////////////////////////////////////////////////
void GPSDecoder::setRinexReconnectFlag(bool flag) {
  if (_rnx) {
    _rnx->setReconnectFlag(flag);
  }
}

// 
//////////////////////////////////////////////////////////////////////////////
void t_obs::setMeasdata(QString rnxStr, float rnxVers, double value) {
  int ie = iEntry(rnxStr, rnxVers);

  if (ie != -1) {
    _codetype[ie] = rnxStr.mid(1);
    _measdata[ie] = value;
  }
}

// 
//////////////////////////////////////////////////////////////////////////////
double t_obs::measdata(QString rnxStr, float rnxVers) const {
  int ie = iEntry(rnxStr, rnxVers);

  if (ie != -1) {
    return _measdata[ie];
  }

  return 0.0;
}

// 
//////////////////////////////////////////////////////////////////////////////
QString t_obs::rnxStr(int iEntry) const {
  QString str(1,' ');
  switch(iEntry & 3) {
    case GNSSENTRY_CODE:    str[0] = 'C'; break;
    case GNSSENTRY_PHASE:   str[0] = 'L'; break;
    case GNSSENTRY_DOPPLER: str[0] = 'D'; break;
    case GNSSENTRY_SNR:     str[0] = 'S'; break;
  }
  str += _codetype[iEntry];
  return str.trimmed();
}

// 
//////////////////////////////////////////////////////////////////////////////
int t_obs::iEntry(QString rnxStr, float rnxVers, bool cmode) const {

  int res = 0;
  bool tryagain = false;
  QString rnxStrOrig = rnxStr;
  
  if (rnxVers < 3.0) {
    if      (rnxStr == "C1") rnxStr = "C1C";
    else if (rnxStr == "P1") rnxStr = "C1P";
    else if (rnxStr == "C2") rnxStr = "C2C";
    else if (rnxStr == "P2") rnxStr = "C2P";
    if(cmode)
    {
      if      (rnxStr == "S1") rnxStr = "S1C";
      else if (rnxStr == "L1") rnxStr = "L1C";
      else if (rnxStr == "S2") rnxStr = "S2C";
      else if (rnxStr == "L2") rnxStr = "L2C";
    }
    else
    {
      if      (rnxStr == "S1") {rnxStr = "S1P"; tryagain = true; }
      else if (rnxStr == "L1") {rnxStr = "L1P"; tryagain = true; }
      else if (rnxStr == "S2") {rnxStr = "S2P"; tryagain = true; }
      else if (rnxStr == "L2") {rnxStr = "L2P"; tryagain = true; }
    }
  }

  // Observation Type (Code, Phase, Doppler, SNR)
  // --------------------------------------------
  if      (rnxStr[0] == 'C') {
    res += GNSSENTRY_CODE;
  }
  else if (rnxStr[0] == 'L') {
    res += GNSSENTRY_PHASE;
  }
  else if (rnxStr[0] == 'D') {
    res += GNSSENTRY_DOPPLER;
  }
  else if (rnxStr[0] == 'S') {
    res += GNSSENTRY_SNR;
  }
  else {
    return -1;
  }

  // Frequency
  // ---------
  if      (rnxStr[1] == '1') {
    if      (rnxStr.length() < 3) {
      res += GNSSENTRY_TYPEC1;
    }
    else if (QString("ABCIQ").indexOf(rnxStr[2]) != -1) {
      res += GNSSENTRY_TYPEC1;
    }
    else if (QString("SL").indexOf(rnxStr[2]) != -1) {
      res += GNSSENTRY_TYPEC1N;
    }
    else if (QString("PWY").indexOf(rnxStr[2])    != -1) {
      res += GNSSENTRY_TYPEP1;
    }
    else if (rnxStr[2] == 'Z') {
      res += GNSSENTRY_TYPECSAIF;
    }
    else if (rnxStr[2] == 'X') {
      if (satSys == 'C' || satSys == 'E') {
        res += GNSSENTRY_TYPEC1;
      }
      else {
        res += GNSSENTRY_TYPEC1N;
      }
    }
    else {
      return -1;
    }
  }
  else if (rnxStr[1] == '2') {
    if      (rnxStr.length() < 3) {
      res += GNSSENTRY_TYPEC2;
    }
    else if (QString("PWY").indexOf(rnxStr[2])  != -1) {
      res += GNSSENTRY_TYPEP2;
    }
    else if (QString("CSLX").indexOf(rnxStr[2]) != -1) {
      res += GNSSENTRY_TYPEC2;
    }
    else if (rnxStr[2] == 'I') {
      if (satSys == 'C') {
        res += GNSSENTRY_TYPEC1;  // Compass: RINEX 3.01 "2I" corresponds to "1I" RINEX 3.02
      }
      else {
        res += GNSSENTRY_TYPEC2;
      }
    }
    else if (rnxStr[2] == 'Q') {
      res += GNSSENTRY_TYPEC2;
    }
    else {
      return -1;
    }
  }
  else if (rnxStr[1] == '5') {
    res += GNSSENTRY_TYPEC5;
  }
  else if (rnxStr[1] == '6') {
    res += GNSSENTRY_TYPEC6;
  }
  else if (rnxStr[1] == '7') {
    res += GNSSENTRY_TYPEC5B;
  }
  else if (rnxStr[1] == '8') {
    res += GNSSENTRY_TYPEC5AB;
  }
  else {
    return -1;
  }

  /* Note: We prefer P over C for Lx or Sx (i.e. we first try for P values) */
  if(_codetype[res].isEmpty() && tryagain)
    res = iEntry(rnxStrOrig, rnxVers, true);

  return res;
}