Browse Source

fw att pos estimator: fix output lat/lon conversion (introduced by changes in 58792c5ca6)

sbg
Thomas Gubler 11 years ago
parent
commit
3f79057dd1
  1. 4
      src/modules/att_pos_estimator_ekf/KalmanNav.cpp

4
src/modules/att_pos_estimator_ekf/KalmanNav.cpp

@ -315,8 +315,8 @@ void KalmanNav::updatePublications() @@ -315,8 +315,8 @@ void KalmanNav::updatePublications()
_pos.timestamp = _pubTimeStamp;
_pos.time_gps_usec = _gps.timestamp_position;
_pos.valid = true;
_pos.lat = getLatDegE7();
_pos.lon = getLonDegE7();
_pos.lat = lat * M_RAD_TO_DEG;
_pos.lon = lon * M_RAD_TO_DEG;
_pos.alt = float(alt);
_pos.vel_n = vN;
_pos.vel_e = vE;

Loading…
Cancel
Save