Changeset 6009 in ntrip for trunk/BNC/src/PPP


Ignore:
Timestamp:
Aug 18, 2014, 11:30:27 AM (10 years ago)
Author:
mervart
Message:
 
File:
1 edited

Legend:

Unmodified
Added
Removed
  • trunk/BNC/src/PPP/pppFilter.cpp

    r6008 r6009  
    440440  bool first = (params[0]->indexOld() < 0);
    441441
     442  SymmetricMatrix Qneu(3); Qneu = 0.0;
     443  for (unsigned ii = 0; ii < 3; ii++) {
     444    const t_pppParam* par = params[ii];
     445    if (first) {
     446      Qneu[ii][ii] = par->sigma0() * par->sigma0();
     447    }
     448    else {
     449      Qneu[ii][ii] = par->noise() * par->noise();
     450    }
     451  }
     452
     453  const t_pppStation* sta = PPP_CLIENT->staRover();
     454  SymmetricMatrix Qxyz(3);
     455  covariNEU_XYZ(Qneu, sta->ellApr().data(), Qxyz);
     456
    442457  if (first) {
    443     _QFlt.SymSubMatrix(1,3) = 0.0;
    444     for (unsigned ii = 0; ii < 3; ii++) {
    445       const t_pppParam* par1 = params[ii];
    446       _QFlt[ii][ii] = par1->sigma0() * par1->sigma0();
    447     }
     458    _QFlt.SymSubMatrix(1,3) = Qxyz;
    448459  }
    449460  else {
    450     _QFlt.SymSubMatrix(1,3) = QFltOld.SymSubMatrix(1,3);
    451     for (unsigned ii = 0; ii < 3; ii++) {
    452       const t_pppParam* par1 = params[ii];
    453       _QFlt[ii][ii] = QFltOld[ii][ii] + par1->noise() * par1->noise();
    454     }
    455   }
    456 }
     461    _QFlt.SymSubMatrix(1,3) = QFltOld.SymSubMatrix(1,3) + Qxyz;
     462  }
     463}
Note: See TracChangeset for help on using the changeset viewer.