spacecruft
/
galmon
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

navdump: print WGS84 lat, lon, and elev in ECEF output

pull/52/head
Josef 'Jeff' Sipek 2019-12-02 12:36:47 -05:00
parent 68083eb12a
commit ed312693c0
1 changed files with 5 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
navdump.cc
View File

@ -625,9 +625,11 @@ try
continue;
etstamp();
auto lonlat = getLongLat(nmm.op().x(), nmm.op().y(), nmm.op().z());
cout<<std::fixed<<"ECEF "<<nmm.op().x()<<", "<<nmm.op().y()<<", "<<nmm.op().z()<< " lon "<< 180*lonlat.first/M_PI << " lat "<<
180*lonlat.second/M_PI<< " acc "<<nmm.op().acc()<<" m "<<endl;
auto latlonh = ecefToWGS84(nmm.op().x(), nmm.op().y(), nmm.op().z());
cout<<std::fixed<<"ECEF "<<nmm.op().x()<<", "<<nmm.op().y()<<", "<<nmm.op().z();
cout<<", WGS84 lon "<< 180*std::get<1>(latlonh)/M_PI
<<" lat "<< 180*std::get<0>(latlonh)/M_PI
<<" elev "<< std::get<2>(latlonh) << " acc "<<nmm.op().acc()<<" m "<<endl;
g_ourpos = Point(nmm.op().x(), nmm.op().y(), nmm.op().z());
}
else if(nmm.type() == NavMonMessage::RFDataType) {