Changeset 5866 in ntrip for trunk/BNC/src/bncutils.cpp


Ignore:
Timestamp:
Aug 8, 2014, 10:53:18 AM (10 years ago)
Author:
mervart
Message:
 
File:
1 edited

Legend:

Unmodified
Added
Removed
  • trunk/BNC/src/bncutils.cpp

    r5846 r5866  
    566566//////////////////////////////////////////////////////////////////////////////
    567567void kalman(const Matrix& AA, const ColumnVector& ll, const DiagonalMatrix& PP,
    568             SymmetricMatrix& QQ, ColumnVector& dx) {
     568            SymmetricMatrix& QQ, ColumnVector& xx) {
    569569
    570570  Tracer tracer("kalman");
     
    595595  SymmetricMatrix Hi; Hi << SHi * SHi.t();
    596596
    597   dx = KT.t() * ll;
     597  xx += KT.t() * (ll - AA * xx);
    598598  QQ << (SS.t() * SS);
    599599}
Note: See TracChangeset for help on using the changeset viewer.