@@ -171,13 +171,6 @@ def find_sv_states(gps_millis, ephem):
171171
172172 sqrt_mu_a = np .sqrt (consts .MU_EARTH ) * sqrt_sma ** - 3 # mean angular motion
173173 gpsweek_diff = (np .mod (gps_week ,1024 ) - np .mod (ephem ['gps_week' ],1024 ))* 604800.
174-
175- #TODO: See if these statements need to be removed
176- # if np.size(times_all)==1:
177- # times_all = times_all*np.ones(len(ephem))
178- # else:
179- # times_all = np.reshape(times_all, len(ephem))
180- # times = times_all
181174 sv_posvel = NavData ()
182175 sv_posvel ['gnss_id' ] = ephem ['gnss_id' ]
183176 sv_posvel ['sv_id' ] = ephem ['sv_id' ]
@@ -188,7 +181,6 @@ def find_sv_states(gps_millis, ephem):
188181 # length as the ephemeris
189182 # print(times.shape)
190183 sv_posvel ['gps_millis' ] = gps_millis
191- #TODO: Update to add gps_millis instead of gps_tow
192184
193185 delta_t = gps_tow - ephem ['t_oe' ] + gpsweek_diff
194186
@@ -230,8 +222,6 @@ def find_sv_states(gps_millis, ephem):
230222 ############################################
231223 ###### Lines added for velocity (1) ######
232224 ############################################
233- #TODO: Factorize out into an internal function for calculating
234- # satellite velocities
235225 delta_e = (sqrt_mu_a + delta_n ) / e_cos_e
236226 dphi = np .sqrt (1 - ecc ** 2 )* delta_e / e_cos_e
237227 # Changed from the paper
@@ -265,8 +255,6 @@ def find_sv_states(gps_millis, ephem):
265255 sv_posvel ['x_sv_m' ] = x_plane * cos_omega - y_plane * cos_i * sin_omega
266256 sv_posvel ['y_sv_m' ] = x_plane * sin_omega + y_plane * cos_i * cos_omega
267257 sv_posvel ['z_sv_m' ] = y_plane * sin_i
268- # TODO: Add satellite clock bias here using the 'clock corrections' not to
269- # be used but compared against SP3 and Android data
270258
271259 ############################################
272260 ###### Lines added for velocity (4) ######
@@ -522,15 +510,6 @@ def _find_sv_location(gps_millis, rx_ecef, ephem=None, sv_posvel=None):
522510 sv_posvel = find_sv_states (gps_millis - 1000. * t_corr , ephem )
523511 del_pos , true_range = _find_delxyz_range (sv_posvel , rx_ecef )
524512 t_corr = true_range / consts .C
525- # Corrections for the rotation of the Earth during transmission
526- #TODO: Should we correct for the rotation of the Earth here or let the
527- # user figure this out during WLS and other estimation methods?
528- # sv_pos, sv_vel = _extract_pos_vel_arr(sv_posvel)
529- del_x = consts .OMEGA_E_DOT * sv_posvel ['x_sv_m' ] * t_corr
530- del_y = consts .OMEGA_E_DOT * sv_posvel ['y_sv_m' ] * t_corr
531- #TODO: Should we keep the following two lines? Doesn't match the Android dataset
532- # sv_posvel['x_sv_m'] = sv_posvel['x_sv_m'] + del_x
533- # sv_posvel['y_sv_m'] = sv_posvel['y_sv_m'] + del_y
534513
535514 return sv_posvel , del_pos , true_range
536515
0 commit comments