Changeset 4681 in ntrip


Ignore:
Timestamp:
Sep 9, 2012, 11:43:49 AM (10 years ago)
Author:
mervart
Message:
 
File:
1 edited

Legend:

Unmodified
Added
Removed
  • trunk/BNC/src/rinex/reqcanalyze.cpp

    r4680 r4681  
    663663                    xSat(1), xSat(2), xSat(3), clkSat);
    664664      ColumnVector dx = xSat - xyzSta;
    665     }
    666 
    667   }
    668 
    669   return 0.0;
    670 }
     665      double rho = dx.norm_Frobenius();
     666      AA(nSatUsed,1) = dx(1) / rho;
     667      AA(nSatUsed,2) = dx(2) / rho;
     668      AA(nSatUsed,3) = dx(3) / rho;
     669      AA(nSatUsed,4) = 1.0;
     670    }
     671  }
     672
     673  if (nSatUsed < 4) {
     674    return 0.0;
     675  }
     676
     677  AA = AA.Rows(1, nSatUsed);
     678
     679  SymmetricMatrix QQ;
     680  QQ << AA.t() * AA;
     681  QQ = QQ.i();
     682
     683  return sqrt(QQ.trace());
     684}
Note: See TracChangeset for help on using the changeset viewer.