Skip to content
Snippets Groups Projects
Commit 9272176f authored by Joan Vallvé Navarro's avatar Joan Vallvé Navarro
Browse files

adapted to new output from GnssUtils::pntpos

parent 2b903a58
No related branches found
No related tags found
2 merge requests!28release after RAL,!27After 2nd RAL submission
...@@ -76,8 +76,11 @@ void ProcessorGnssFix::processCapture(CaptureBasePtr _capture) ...@@ -76,8 +76,11 @@ void ProcessorGnssFix::processCapture(CaptureBasePtr _capture)
{ {
auto raw_capture = std::static_pointer_cast<CaptureGnss>(incoming_capture_); auto raw_capture = std::static_pointer_cast<CaptureGnss>(incoming_capture_);
incoming_pos_out_ = GnssUtils::computePos(*(raw_capture->getObservations()), *(raw_capture->getNavigation()), params_gnss_->compute_pos_opt); incoming_pos_out_ = GnssUtils::computePos(*(raw_capture->getObservations()), *(raw_capture->getNavigation()), params_gnss_->compute_pos_opt);
if (incoming_pos_out_.pos_stat == 0) // error if (!incoming_pos_out_.success) // error
{
WOLF_DEBUG("computePos failed with msg: ", incoming_pos_out_.msg);
return; return;
}
} }
else else
{ {
......
...@@ -41,7 +41,7 @@ void ProcessorTrackerGnss::preProcess() ...@@ -41,7 +41,7 @@ void ProcessorTrackerGnss::preProcess()
params_tracker_gnss_->fix_opt); params_tracker_gnss_->fix_opt);
// Set ECEF-ENU // Set ECEF-ENU
if (!sensor_gnss_->isEnuDefined() and sensor_gnss_->isEnuModeAuto() and fix_incoming_.stat != 0) if (!sensor_gnss_->isEnuDefined() and sensor_gnss_->isEnuModeAuto() and fix_incoming_.success)
{ {
WOLF_INFO("setting ECEF-ENU: ", fix_incoming_.pos.transpose()); WOLF_INFO("setting ECEF-ENU: ", fix_incoming_.pos.transpose());
sensor_gnss_->setEcefEnu(fix_incoming_.pos, true); sensor_gnss_->setEcefEnu(fix_incoming_.pos, true);
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment