Modify pseudorange calculation

ut-issl · Jan 5, 2025 · b693e5f · b693e5f
1 parent 1f6d31e
commit b693e5f
Showing 1 changed file with 5 additions and 5 deletions.
diff --git a/src/components/real/aocs/gnss_receiver.cpp b/src/components/real/aocs/gnss_receiver.cpp
@@ -69,16 +69,16 @@ void GnssReceiver::MainRoutine(const int time_count) {
   CheckAntenna(position_true_eci, quaternion_i2b);
 
   // Pseudorange calculation
-  // size_t number_of_calculated_gnss_satellites = gnss_satellites_->GetNumberOfCalculatedSatellite();
-  // for (size_t i = 0; i < number_of_calculated_gnss_satellites; i++) {
-  //   math::Vector<3> gnss_satellite_position_ecef_m = gnss_satellites_->GetPosition_ecef_m(i);
-  //   math::Vector<3> position_true_ecef_m = dynamics_->GetOrbit().GetPosition_ecef_m();
+  size_t number_of_calculated_gnss_satellites = gnss_satellites_->GetNumberOfCalculatedSatellite();
+  for (size_t i = 0; i < number_of_calculated_gnss_satellites; i++) {
+    math::Vector<3> gnss_satellite_position_ecef_m = gnss_satellites_->GetPosition_ecef_m(i);
+    math::Vector<3> position_true_ecef_m = dynamics_->GetOrbit().GetPosition_ecef_m();
   //   double geometric_distance_m = (gnss_satellite_position_ecef_m - position_true_ecef_m).CalcNorm();
   //   randomization::NormalRand pseudorange_random_noise_m;
   //   pseudorange_random_noise_m.SetParameters(0.0, pseudorange_noise_standard_deviation_m_, randomization::global_randomization.MakeSeed());
   //   double pseudorange_m = geometric_distance_m + pseudorange_random_noise_m;
   //   pseudorange_list_m_[i] = pseudorange_m;
-  // }
+  }
 
   if (is_gnss_visible_) {
     // Antenna of GNSS-R can detect GNSS signal